LCOV - code coverage report
Current view: top level - drivers/pci - access.c (source / functions) Hit Total Coverage
Test: combined.info Lines: 39 194 20.1 %
Date: 2022-04-01 14:35:51 Functions: 16 36 44.4 %
Branches: 20 164 12.2 %

           Branch data     Line data    Source code
       1                 :            : // SPDX-License-Identifier: GPL-2.0
       2                 :            : #include <linux/pci.h>
       3                 :            : #include <linux/module.h>
       4                 :            : #include <linux/slab.h>
       5                 :            : #include <linux/ioport.h>
       6                 :            : #include <linux/wait.h>
       7                 :            : 
       8                 :            : #include "pci.h"
       9                 :            : 
      10                 :            : /*
      11                 :            :  * This interrupt-safe spinlock protects all accesses to PCI
      12                 :            :  * configuration space.
      13                 :            :  */
      14                 :            : 
      15                 :            : DEFINE_RAW_SPINLOCK(pci_lock);
      16                 :            : 
      17                 :            : /*
      18                 :            :  * Wrappers for all PCI configuration access functions.  They just check
      19                 :            :  * alignment, do locking and call the low-level functions pointed to
      20                 :            :  * by pci_dev->ops.
      21                 :            :  */
      22                 :            : 
      23                 :            : #define PCI_byte_BAD 0
      24                 :            : #define PCI_word_BAD (pos & 1)
      25                 :            : #define PCI_dword_BAD (pos & 3)
      26                 :            : 
      27                 :            : #ifdef CONFIG_PCI_LOCKLESS_CONFIG
      28                 :            : # define pci_lock_config(f)     do { (void)(f); } while (0)
      29                 :            : # define pci_unlock_config(f)   do { (void)(f); } while (0)
      30                 :            : #else
      31                 :            : # define pci_lock_config(f)     raw_spin_lock_irqsave(&pci_lock, f)
      32                 :            : # define pci_unlock_config(f)   raw_spin_unlock_irqrestore(&pci_lock, f)
      33                 :            : #endif
      34                 :            : 
      35                 :            : #define PCI_OP_READ(size, type, len) \
      36                 :            : int noinline pci_bus_read_config_##size \
      37                 :            :         (struct pci_bus *bus, unsigned int devfn, int pos, type *value) \
      38                 :            : {                                                                       \
      39                 :            :         int res;                                                        \
      40                 :            :         unsigned long flags;                                            \
      41                 :            :         u32 data = 0;                                                   \
      42                 :            :         if (PCI_##size##_BAD) return PCIBIOS_BAD_REGISTER_NUMBER;       \
      43                 :            :         pci_lock_config(flags);                                         \
      44                 :            :         res = bus->ops->read(bus, devfn, pos, len, &data);            \
      45                 :            :         *value = (type)data;                                            \
      46                 :            :         pci_unlock_config(flags);                                       \
      47                 :            :         return res;                                                     \
      48                 :            : }
      49                 :            : 
      50                 :            : #define PCI_OP_WRITE(size, type, len) \
      51                 :            : int noinline pci_bus_write_config_##size \
      52                 :            :         (struct pci_bus *bus, unsigned int devfn, int pos, type value)  \
      53                 :            : {                                                                       \
      54                 :            :         int res;                                                        \
      55                 :            :         unsigned long flags;                                            \
      56                 :            :         if (PCI_##size##_BAD) return PCIBIOS_BAD_REGISTER_NUMBER;       \
      57                 :            :         pci_lock_config(flags);                                         \
      58                 :            :         res = bus->ops->write(bus, devfn, pos, len, value);               \
      59                 :            :         pci_unlock_config(flags);                                       \
      60                 :            :         return res;                                                     \
      61                 :            : }
      62                 :            : 
      63                 :       1155 : PCI_OP_READ(byte, u8, 1)
      64         [ +  - ]:       4158 : PCI_OP_READ(word, u16, 2)
      65         [ +  - ]:       4221 : PCI_OP_READ(dword, u32, 4)
      66                 :        147 : PCI_OP_WRITE(byte, u8, 1)
      67         [ +  - ]:       2310 : PCI_OP_WRITE(word, u16, 2)
      68         [ +  - ]:       2079 : PCI_OP_WRITE(dword, u32, 4)
      69                 :            : 
      70                 :            : EXPORT_SYMBOL(pci_bus_read_config_byte);
      71                 :            : EXPORT_SYMBOL(pci_bus_read_config_word);
      72                 :            : EXPORT_SYMBOL(pci_bus_read_config_dword);
      73                 :            : EXPORT_SYMBOL(pci_bus_write_config_byte);
      74                 :            : EXPORT_SYMBOL(pci_bus_write_config_word);
      75                 :            : EXPORT_SYMBOL(pci_bus_write_config_dword);
      76                 :            : 
      77                 :          0 : int pci_generic_config_read(struct pci_bus *bus, unsigned int devfn,
      78                 :            :                             int where, int size, u32 *val)
      79                 :            : {
      80                 :          0 :         void __iomem *addr;
      81                 :            : 
      82                 :          0 :         addr = bus->ops->map_bus(bus, devfn, where);
      83         [ #  # ]:          0 :         if (!addr) {
      84                 :          0 :                 *val = ~0;
      85                 :          0 :                 return PCIBIOS_DEVICE_NOT_FOUND;
      86                 :            :         }
      87                 :            : 
      88         [ #  # ]:          0 :         if (size == 1)
      89                 :          0 :                 *val = readb(addr);
      90         [ #  # ]:          0 :         else if (size == 2)
      91                 :          0 :                 *val = readw(addr);
      92                 :            :         else
      93                 :          0 :                 *val = readl(addr);
      94                 :            : 
      95                 :            :         return PCIBIOS_SUCCESSFUL;
      96                 :            : }
      97                 :            : EXPORT_SYMBOL_GPL(pci_generic_config_read);
      98                 :            : 
      99                 :          0 : int pci_generic_config_write(struct pci_bus *bus, unsigned int devfn,
     100                 :            :                              int where, int size, u32 val)
     101                 :            : {
     102                 :          0 :         void __iomem *addr;
     103                 :            : 
     104                 :          0 :         addr = bus->ops->map_bus(bus, devfn, where);
     105         [ #  # ]:          0 :         if (!addr)
     106                 :            :                 return PCIBIOS_DEVICE_NOT_FOUND;
     107                 :            : 
     108         [ #  # ]:          0 :         if (size == 1)
     109                 :          0 :                 writeb(val, addr);
     110         [ #  # ]:          0 :         else if (size == 2)
     111                 :          0 :                 writew(val, addr);
     112                 :            :         else
     113                 :          0 :                 writel(val, addr);
     114                 :            : 
     115                 :            :         return PCIBIOS_SUCCESSFUL;
     116                 :            : }
     117                 :            : EXPORT_SYMBOL_GPL(pci_generic_config_write);
     118                 :            : 
     119                 :          0 : int pci_generic_config_read32(struct pci_bus *bus, unsigned int devfn,
     120                 :            :                               int where, int size, u32 *val)
     121                 :            : {
     122                 :          0 :         void __iomem *addr;
     123                 :            : 
     124                 :          0 :         addr = bus->ops->map_bus(bus, devfn, where & ~0x3);
     125         [ #  # ]:          0 :         if (!addr) {
     126                 :          0 :                 *val = ~0;
     127                 :          0 :                 return PCIBIOS_DEVICE_NOT_FOUND;
     128                 :            :         }
     129                 :            : 
     130                 :          0 :         *val = readl(addr);
     131                 :            : 
     132         [ #  # ]:          0 :         if (size <= 2)
     133                 :          0 :                 *val = (*val >> (8 * (where & 3))) & ((1 << (size * 8)) - 1);
     134                 :            : 
     135                 :            :         return PCIBIOS_SUCCESSFUL;
     136                 :            : }
     137                 :            : EXPORT_SYMBOL_GPL(pci_generic_config_read32);
     138                 :            : 
     139                 :          0 : int pci_generic_config_write32(struct pci_bus *bus, unsigned int devfn,
     140                 :            :                                int where, int size, u32 val)
     141                 :            : {
     142                 :          0 :         void __iomem *addr;
     143                 :          0 :         u32 mask, tmp;
     144                 :            : 
     145                 :          0 :         addr = bus->ops->map_bus(bus, devfn, where & ~0x3);
     146         [ #  # ]:          0 :         if (!addr)
     147                 :            :                 return PCIBIOS_DEVICE_NOT_FOUND;
     148                 :            : 
     149         [ #  # ]:          0 :         if (size == 4) {
     150                 :          0 :                 writel(val, addr);
     151                 :          0 :                 return PCIBIOS_SUCCESSFUL;
     152                 :            :         }
     153                 :            : 
     154                 :            :         /*
     155                 :            :          * In general, hardware that supports only 32-bit writes on PCI is
     156                 :            :          * not spec-compliant.  For example, software may perform a 16-bit
     157                 :            :          * write.  If the hardware only supports 32-bit accesses, we must
     158                 :            :          * do a 32-bit read, merge in the 16 bits we intend to write,
     159                 :            :          * followed by a 32-bit write.  If the 16 bits we *don't* intend to
     160                 :            :          * write happen to have any RW1C (write-one-to-clear) bits set, we
     161                 :            :          * just inadvertently cleared something we shouldn't have.
     162                 :            :          */
     163         [ #  # ]:          0 :         dev_warn_ratelimited(&bus->dev, "%d-byte config write to %04x:%02x:%02x.%d offset %#x may corrupt adjacent RW1C bits\n",
     164                 :            :                              size, pci_domain_nr(bus), bus->number,
     165                 :            :                              PCI_SLOT(devfn), PCI_FUNC(devfn), where);
     166                 :            : 
     167                 :          0 :         mask = ~(((1 << (size * 8)) - 1) << ((where & 0x3) * 8));
     168                 :          0 :         tmp = readl(addr) & mask;
     169                 :          0 :         tmp |= val << ((where & 0x3) * 8);
     170                 :          0 :         writel(tmp, addr);
     171                 :            : 
     172                 :          0 :         return PCIBIOS_SUCCESSFUL;
     173                 :            : }
     174                 :            : EXPORT_SYMBOL_GPL(pci_generic_config_write32);
     175                 :            : 
     176                 :            : /**
     177                 :            :  * pci_bus_set_ops - Set raw operations of pci bus
     178                 :            :  * @bus:        pci bus struct
     179                 :            :  * @ops:        new raw operations
     180                 :            :  *
     181                 :            :  * Return previous raw operations
     182                 :            :  */
     183                 :          0 : struct pci_ops *pci_bus_set_ops(struct pci_bus *bus, struct pci_ops *ops)
     184                 :            : {
     185                 :          0 :         struct pci_ops *old_ops;
     186                 :          0 :         unsigned long flags;
     187                 :            : 
     188                 :          0 :         raw_spin_lock_irqsave(&pci_lock, flags);
     189                 :          0 :         old_ops = bus->ops;
     190                 :          0 :         bus->ops = ops;
     191                 :          0 :         raw_spin_unlock_irqrestore(&pci_lock, flags);
     192                 :          0 :         return old_ops;
     193                 :            : }
     194                 :            : EXPORT_SYMBOL(pci_bus_set_ops);
     195                 :            : 
     196                 :            : /*
     197                 :            :  * The following routines are to prevent the user from accessing PCI config
     198                 :            :  * space when it's unsafe to do so.  Some devices require this during BIST and
     199                 :            :  * we're required to prevent it during D-state transitions.
     200                 :            :  *
     201                 :            :  * We have a bit per device to indicate it's blocked and a global wait queue
     202                 :            :  * for callers to sleep on until devices are unblocked.
     203                 :            :  */
     204                 :            : static DECLARE_WAIT_QUEUE_HEAD(pci_cfg_wait);
     205                 :            : 
     206                 :          0 : static noinline void pci_wait_cfg(struct pci_dev *dev)
     207                 :            : {
     208                 :          0 :         DECLARE_WAITQUEUE(wait, current);
     209                 :            : 
     210                 :          0 :         __add_wait_queue(&pci_cfg_wait, &wait);
     211                 :          0 :         do {
     212                 :          0 :                 set_current_state(TASK_UNINTERRUPTIBLE);
     213                 :          0 :                 raw_spin_unlock_irq(&pci_lock);
     214                 :          0 :                 schedule();
     215                 :          0 :                 raw_spin_lock_irq(&pci_lock);
     216         [ #  # ]:          0 :         } while (dev->block_cfg_access);
     217                 :          0 :         __remove_wait_queue(&pci_cfg_wait, &wait);
     218                 :          0 : }
     219                 :            : 
     220                 :            : /* Returns 0 on success, negative values indicate error. */
     221                 :            : #define PCI_USER_READ_CONFIG(size, type)                                        \
     222                 :            : int pci_user_read_config_##size                                         \
     223                 :            :         (struct pci_dev *dev, int pos, type *val)                       \
     224                 :            : {                                                                       \
     225                 :            :         int ret = PCIBIOS_SUCCESSFUL;                                   \
     226                 :            :         u32 data = -1;                                                  \
     227                 :            :         if (PCI_##size##_BAD)                                           \
     228                 :            :                 return -EINVAL;                                         \
     229                 :            :         raw_spin_lock_irq(&pci_lock);                               \
     230                 :            :         if (unlikely(dev->block_cfg_access))                         \
     231                 :            :                 pci_wait_cfg(dev);                                      \
     232                 :            :         ret = dev->bus->ops->read(dev->bus, dev->devfn,                  \
     233                 :            :                                         pos, sizeof(type), &data);  \
     234                 :            :         raw_spin_unlock_irq(&pci_lock);                             \
     235                 :            :         *val = (type)data;                                              \
     236                 :            :         return pcibios_err_to_errno(ret);                               \
     237                 :            : }                                                                       \
     238                 :            : EXPORT_SYMBOL_GPL(pci_user_read_config_##size);
     239                 :            : 
     240                 :            : /* Returns 0 on success, negative values indicate error. */
     241                 :            : #define PCI_USER_WRITE_CONFIG(size, type)                               \
     242                 :            : int pci_user_write_config_##size                                        \
     243                 :            :         (struct pci_dev *dev, int pos, type val)                        \
     244                 :            : {                                                                       \
     245                 :            :         int ret = PCIBIOS_SUCCESSFUL;                                   \
     246                 :            :         if (PCI_##size##_BAD)                                           \
     247                 :            :                 return -EINVAL;                                         \
     248                 :            :         raw_spin_lock_irq(&pci_lock);                               \
     249                 :            :         if (unlikely(dev->block_cfg_access))                         \
     250                 :            :                 pci_wait_cfg(dev);                                      \
     251                 :            :         ret = dev->bus->ops->write(dev->bus, dev->devfn,         \
     252                 :            :                                         pos, sizeof(type), val);        \
     253                 :            :         raw_spin_unlock_irq(&pci_lock);                             \
     254                 :            :         return pcibios_err_to_errno(ret);                               \
     255                 :            : }                                                                       \
     256                 :            : EXPORT_SYMBOL_GPL(pci_user_write_config_##size);
     257                 :            : 
     258   [ #  #  #  # ]:          0 : PCI_USER_READ_CONFIG(byte, u8)
     259   [ #  #  #  #  :          0 : PCI_USER_READ_CONFIG(word, u16)
                   #  # ]
     260   [ +  -  -  +  :       1344 : PCI_USER_READ_CONFIG(dword, u32)
                   -  + ]
     261   [ #  #  #  # ]:          0 : PCI_USER_WRITE_CONFIG(byte, u8)
     262   [ #  #  #  #  :          0 : PCI_USER_WRITE_CONFIG(word, u16)
                   #  # ]
     263   [ #  #  #  #  :          0 : PCI_USER_WRITE_CONFIG(dword, u32)
                   #  # ]
     264                 :            : 
     265                 :            : /**
     266                 :            :  * pci_cfg_access_lock - Lock PCI config reads/writes
     267                 :            :  * @dev:        pci device struct
     268                 :            :  *
     269                 :            :  * When access is locked, any userspace reads or writes to config
     270                 :            :  * space and concurrent lock requests will sleep until access is
     271                 :            :  * allowed via pci_cfg_access_unlock() again.
     272                 :            :  */
     273                 :          0 : void pci_cfg_access_lock(struct pci_dev *dev)
     274                 :            : {
     275                 :          0 :         might_sleep();
     276                 :            : 
     277                 :          0 :         raw_spin_lock_irq(&pci_lock);
     278         [ #  # ]:          0 :         if (dev->block_cfg_access)
     279                 :          0 :                 pci_wait_cfg(dev);
     280                 :          0 :         dev->block_cfg_access = 1;
     281                 :          0 :         raw_spin_unlock_irq(&pci_lock);
     282                 :          0 : }
     283                 :            : EXPORT_SYMBOL_GPL(pci_cfg_access_lock);
     284                 :            : 
     285                 :            : /**
     286                 :            :  * pci_cfg_access_trylock - try to lock PCI config reads/writes
     287                 :            :  * @dev:        pci device struct
     288                 :            :  *
     289                 :            :  * Same as pci_cfg_access_lock, but will return 0 if access is
     290                 :            :  * already locked, 1 otherwise. This function can be used from
     291                 :            :  * atomic contexts.
     292                 :            :  */
     293                 :          0 : bool pci_cfg_access_trylock(struct pci_dev *dev)
     294                 :            : {
     295                 :          0 :         unsigned long flags;
     296                 :          0 :         bool locked = true;
     297                 :            : 
     298                 :          0 :         raw_spin_lock_irqsave(&pci_lock, flags);
     299         [ #  # ]:          0 :         if (dev->block_cfg_access)
     300                 :            :                 locked = false;
     301                 :            :         else
     302                 :          0 :                 dev->block_cfg_access = 1;
     303                 :          0 :         raw_spin_unlock_irqrestore(&pci_lock, flags);
     304                 :            : 
     305                 :          0 :         return locked;
     306                 :            : }
     307                 :            : EXPORT_SYMBOL_GPL(pci_cfg_access_trylock);
     308                 :            : 
     309                 :            : /**
     310                 :            :  * pci_cfg_access_unlock - Unlock PCI config reads/writes
     311                 :            :  * @dev:        pci device struct
     312                 :            :  *
     313                 :            :  * This function allows PCI config accesses to resume.
     314                 :            :  */
     315                 :          0 : void pci_cfg_access_unlock(struct pci_dev *dev)
     316                 :            : {
     317                 :          0 :         unsigned long flags;
     318                 :            : 
     319                 :          0 :         raw_spin_lock_irqsave(&pci_lock, flags);
     320                 :            : 
     321                 :            :         /*
     322                 :            :          * This indicates a problem in the caller, but we don't need
     323                 :            :          * to kill them, unlike a double-block above.
     324                 :            :          */
     325         [ #  # ]:          0 :         WARN_ON(!dev->block_cfg_access);
     326                 :            : 
     327                 :          0 :         dev->block_cfg_access = 0;
     328                 :          0 :         raw_spin_unlock_irqrestore(&pci_lock, flags);
     329                 :            : 
     330                 :          0 :         wake_up_all(&pci_cfg_wait);
     331                 :          0 : }
     332                 :            : EXPORT_SYMBOL_GPL(pci_cfg_access_unlock);
     333                 :            : 
     334                 :          0 : static inline int pcie_cap_version(const struct pci_dev *dev)
     335                 :            : {
     336                 :          0 :         return pcie_caps_reg(dev) & PCI_EXP_FLAGS_VERS;
     337                 :            : }
     338                 :            : 
     339                 :          0 : bool pcie_cap_has_lnkctl(const struct pci_dev *dev)
     340                 :            : {
     341         [ #  # ]:          0 :         int type = pci_pcie_type(dev);
     342                 :            : 
     343                 :          0 :         return type == PCI_EXP_TYPE_ENDPOINT ||
     344                 :          0 :                type == PCI_EXP_TYPE_LEG_END ||
     345                 :          0 :                type == PCI_EXP_TYPE_ROOT_PORT ||
     346   [ #  #  #  # ]:          0 :                type == PCI_EXP_TYPE_UPSTREAM ||
     347                 :            :                type == PCI_EXP_TYPE_DOWNSTREAM ||
     348   [ #  #  #  #  :          0 :                type == PCI_EXP_TYPE_PCI_BRIDGE ||
             #  #  #  # ]
     349                 :            :                type == PCI_EXP_TYPE_PCIE_BRIDGE;
     350                 :            : }
     351                 :            : 
     352                 :          0 : static inline bool pcie_cap_has_sltctl(const struct pci_dev *dev)
     353                 :            : {
     354   [ #  #  #  # ]:          0 :         return pcie_downstream_port(dev) &&
     355                 :            :                pcie_caps_reg(dev) & PCI_EXP_FLAGS_SLOT;
     356                 :            : }
     357                 :            : 
     358                 :          0 : bool pcie_cap_has_rtctl(const struct pci_dev *dev)
     359                 :            : {
     360                 :          0 :         int type = pci_pcie_type(dev);
     361                 :            : 
     362                 :          0 :         return type == PCI_EXP_TYPE_ROOT_PORT ||
     363                 :          0 :                type == PCI_EXP_TYPE_RC_EC;
     364                 :            : }
     365                 :            : 
     366                 :        294 : static bool pcie_capability_reg_implemented(struct pci_dev *dev, int pos)
     367                 :            : {
     368         [ -  + ]:        294 :         if (!pci_is_pcie(dev))
     369                 :            :                 return false;
     370                 :            : 
     371   [ #  #  #  #  :          0 :         switch (pos) {
                   #  # ]
     372                 :            :         case PCI_EXP_FLAGS:
     373                 :            :                 return true;
     374                 :            :         case PCI_EXP_DEVCAP:
     375                 :            :         case PCI_EXP_DEVCTL:
     376                 :            :         case PCI_EXP_DEVSTA:
     377                 :            :                 return true;
     378                 :            :         case PCI_EXP_LNKCAP:
     379                 :            :         case PCI_EXP_LNKCTL:
     380                 :            :         case PCI_EXP_LNKSTA:
     381         [ #  # ]:          0 :                 return pcie_cap_has_lnkctl(dev);
     382                 :            :         case PCI_EXP_SLTCAP:
     383                 :            :         case PCI_EXP_SLTCTL:
     384                 :            :         case PCI_EXP_SLTSTA:
     385         [ #  # ]:          0 :                 return pcie_cap_has_sltctl(dev);
     386                 :            :         case PCI_EXP_RTCTL:
     387                 :            :         case PCI_EXP_RTCAP:
     388                 :            :         case PCI_EXP_RTSTA:
     389                 :          0 :                 return pcie_cap_has_rtctl(dev);
     390                 :            :         case PCI_EXP_DEVCAP2:
     391                 :            :         case PCI_EXP_DEVCTL2:
     392                 :            :         case PCI_EXP_LNKCAP2:
     393                 :            :         case PCI_EXP_LNKCTL2:
     394                 :            :         case PCI_EXP_LNKSTA2:
     395                 :          0 :                 return pcie_cap_version(dev) > 1;
     396                 :          0 :         default:
     397                 :          0 :                 return false;
     398                 :            :         }
     399                 :            : }
     400                 :            : 
     401                 :            : /*
     402                 :            :  * Note that these accessor functions are only for the "PCI Express
     403                 :            :  * Capability" (see PCIe spec r3.0, sec 7.8).  They do not apply to the
     404                 :            :  * other "PCI Express Extended Capabilities" (AER, VC, ACS, MFVC, etc.)
     405                 :            :  */
     406                 :        147 : int pcie_capability_read_word(struct pci_dev *dev, int pos, u16 *val)
     407                 :            : {
     408                 :        147 :         int ret;
     409                 :            : 
     410                 :        147 :         *val = 0;
     411         [ +  - ]:        147 :         if (pos & 1)
     412                 :            :                 return -EINVAL;
     413                 :            : 
     414         [ -  + ]:        147 :         if (pcie_capability_reg_implemented(dev, pos)) {
     415         [ #  # ]:          0 :                 ret = pci_read_config_word(dev, pci_pcie_cap(dev) + pos, val);
     416                 :            :                 /*
     417                 :            :                  * Reset *val to 0 if pci_read_config_word() fails, it may
     418                 :            :                  * have been written as 0xFFFF if hardware error happens
     419                 :            :                  * during pci_read_config_word().
     420                 :            :                  */
     421         [ #  # ]:          0 :                 if (ret)
     422                 :          0 :                         *val = 0;
     423                 :          0 :                 return ret;
     424                 :            :         }
     425                 :            : 
     426                 :            :         /*
     427                 :            :          * For Functions that do not implement the Slot Capabilities,
     428                 :            :          * Slot Status, and Slot Control registers, these spaces must
     429                 :            :          * be hardwired to 0b, with the exception of the Presence Detect
     430                 :            :          * State bit in the Slot Status register of Downstream Ports,
     431                 :            :          * which must be hardwired to 1b.  (PCIe Base Spec 3.0, sec 7.8)
     432                 :            :          */
     433   [ -  +  -  -  :        147 :         if (pci_is_pcie(dev) && pcie_downstream_port(dev) &&
                   -  - ]
     434                 :            :             pos == PCI_EXP_SLTSTA)
     435                 :          0 :                 *val = PCI_EXP_SLTSTA_PDS;
     436                 :            : 
     437                 :            :         return 0;
     438                 :            : }
     439                 :            : EXPORT_SYMBOL(pcie_capability_read_word);
     440                 :            : 
     441                 :        147 : int pcie_capability_read_dword(struct pci_dev *dev, int pos, u32 *val)
     442                 :            : {
     443                 :        147 :         int ret;
     444                 :            : 
     445                 :        147 :         *val = 0;
     446         [ +  - ]:        147 :         if (pos & 3)
     447                 :            :                 return -EINVAL;
     448                 :            : 
     449         [ -  + ]:        147 :         if (pcie_capability_reg_implemented(dev, pos)) {
     450         [ #  # ]:          0 :                 ret = pci_read_config_dword(dev, pci_pcie_cap(dev) + pos, val);
     451                 :            :                 /*
     452                 :            :                  * Reset *val to 0 if pci_read_config_dword() fails, it may
     453                 :            :                  * have been written as 0xFFFFFFFF if hardware error happens
     454                 :            :                  * during pci_read_config_dword().
     455                 :            :                  */
     456         [ #  # ]:          0 :                 if (ret)
     457                 :          0 :                         *val = 0;
     458                 :          0 :                 return ret;
     459                 :            :         }
     460                 :            : 
     461   [ -  +  -  -  :        147 :         if (pci_is_pcie(dev) && pcie_downstream_port(dev) &&
                   -  - ]
     462                 :            :             pos == PCI_EXP_SLTSTA)
     463                 :          0 :                 *val = PCI_EXP_SLTSTA_PDS;
     464                 :            : 
     465                 :            :         return 0;
     466                 :            : }
     467                 :            : EXPORT_SYMBOL(pcie_capability_read_dword);
     468                 :            : 
     469                 :          0 : int pcie_capability_write_word(struct pci_dev *dev, int pos, u16 val)
     470                 :            : {
     471         [ #  # ]:          0 :         if (pos & 1)
     472                 :            :                 return -EINVAL;
     473                 :            : 
     474         [ #  # ]:          0 :         if (!pcie_capability_reg_implemented(dev, pos))
     475                 :            :                 return 0;
     476                 :            : 
     477         [ #  # ]:          0 :         return pci_write_config_word(dev, pci_pcie_cap(dev) + pos, val);
     478                 :            : }
     479                 :            : EXPORT_SYMBOL(pcie_capability_write_word);
     480                 :            : 
     481                 :          0 : int pcie_capability_write_dword(struct pci_dev *dev, int pos, u32 val)
     482                 :            : {
     483         [ #  # ]:          0 :         if (pos & 3)
     484                 :            :                 return -EINVAL;
     485                 :            : 
     486         [ #  # ]:          0 :         if (!pcie_capability_reg_implemented(dev, pos))
     487                 :            :                 return 0;
     488                 :            : 
     489         [ #  # ]:          0 :         return pci_write_config_dword(dev, pci_pcie_cap(dev) + pos, val);
     490                 :            : }
     491                 :            : EXPORT_SYMBOL(pcie_capability_write_dword);
     492                 :            : 
     493                 :          0 : int pcie_capability_clear_and_set_word(struct pci_dev *dev, int pos,
     494                 :            :                                        u16 clear, u16 set)
     495                 :            : {
     496                 :          0 :         int ret;
     497                 :          0 :         u16 val;
     498                 :            : 
     499                 :          0 :         ret = pcie_capability_read_word(dev, pos, &val);
     500         [ #  # ]:          0 :         if (!ret) {
     501                 :          0 :                 val &= ~clear;
     502                 :          0 :                 val |= set;
     503                 :          0 :                 ret = pcie_capability_write_word(dev, pos, val);
     504                 :            :         }
     505                 :            : 
     506                 :          0 :         return ret;
     507                 :            : }
     508                 :            : EXPORT_SYMBOL(pcie_capability_clear_and_set_word);
     509                 :            : 
     510                 :          0 : int pcie_capability_clear_and_set_dword(struct pci_dev *dev, int pos,
     511                 :            :                                         u32 clear, u32 set)
     512                 :            : {
     513                 :          0 :         int ret;
     514                 :          0 :         u32 val;
     515                 :            : 
     516                 :          0 :         ret = pcie_capability_read_dword(dev, pos, &val);
     517         [ #  # ]:          0 :         if (!ret) {
     518                 :          0 :                 val &= ~clear;
     519                 :          0 :                 val |= set;
     520                 :          0 :                 ret = pcie_capability_write_dword(dev, pos, val);
     521                 :            :         }
     522                 :            : 
     523                 :          0 :         return ret;
     524                 :            : }
     525                 :            : EXPORT_SYMBOL(pcie_capability_clear_and_set_dword);
     526                 :            : 
     527                 :        945 : int pci_read_config_byte(const struct pci_dev *dev, int where, u8 *val)
     528                 :            : {
     529         [ -  + ]:        945 :         if (pci_dev_is_disconnected(dev)) {
     530                 :          0 :                 *val = ~0;
     531                 :          0 :                 return PCIBIOS_DEVICE_NOT_FOUND;
     532                 :            :         }
     533                 :        945 :         return pci_bus_read_config_byte(dev->bus, dev->devfn, where, val);
     534                 :            : }
     535                 :            : EXPORT_SYMBOL(pci_read_config_byte);
     536                 :            : 
     537                 :       2457 : int pci_read_config_word(const struct pci_dev *dev, int where, u16 *val)
     538                 :            : {
     539   [ -  +  -  - ]:       2457 :         if (pci_dev_is_disconnected(dev)) {
     540                 :          0 :                 *val = ~0;
     541                 :          0 :                 return PCIBIOS_DEVICE_NOT_FOUND;
     542                 :            :         }
     543                 :       2457 :         return pci_bus_read_config_word(dev->bus, dev->devfn, where, val);
     544                 :            : }
     545                 :            : EXPORT_SYMBOL(pci_read_config_word);
     546                 :            : 
     547                 :       2709 : int pci_read_config_dword(const struct pci_dev *dev, int where,
     548                 :            :                                         u32 *val)
     549                 :            : {
     550   [ -  +  -  - ]:       2709 :         if (pci_dev_is_disconnected(dev)) {
     551                 :          0 :                 *val = ~0;
     552                 :          0 :                 return PCIBIOS_DEVICE_NOT_FOUND;
     553                 :            :         }
     554                 :       2709 :         return pci_bus_read_config_dword(dev->bus, dev->devfn, where, val);
     555                 :            : }
     556                 :            : EXPORT_SYMBOL(pci_read_config_dword);
     557                 :            : 
     558                 :        147 : int pci_write_config_byte(const struct pci_dev *dev, int where, u8 val)
     559                 :            : {
     560         [ +  - ]:        147 :         if (pci_dev_is_disconnected(dev))
     561                 :            :                 return PCIBIOS_DEVICE_NOT_FOUND;
     562                 :        147 :         return pci_bus_write_config_byte(dev->bus, dev->devfn, where, val);
     563                 :            : }
     564                 :            : EXPORT_SYMBOL(pci_write_config_byte);
     565                 :            : 
     566                 :       2310 : int pci_write_config_word(const struct pci_dev *dev, int where, u16 val)
     567                 :            : {
     568   [ +  -  -  - ]:       2310 :         if (pci_dev_is_disconnected(dev))
     569                 :            :                 return PCIBIOS_DEVICE_NOT_FOUND;
     570                 :       2310 :         return pci_bus_write_config_word(dev->bus, dev->devfn, where, val);
     571                 :            : }
     572                 :            : EXPORT_SYMBOL(pci_write_config_word);
     573                 :            : 
     574                 :       2079 : int pci_write_config_dword(const struct pci_dev *dev, int where,
     575                 :            :                                          u32 val)
     576                 :            : {
     577   [ +  -  -  - ]:       2079 :         if (pci_dev_is_disconnected(dev))
     578                 :            :                 return PCIBIOS_DEVICE_NOT_FOUND;
     579                 :       2079 :         return pci_bus_write_config_dword(dev->bus, dev->devfn, where, val);
     580                 :            : }
     581                 :            : EXPORT_SYMBOL(pci_write_config_dword);

Generated by: LCOV version 1.14