linux-imx

// SPDX-License-Identifier: GPL-2.0

#include <linux/pci.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/ioport.h>

#include <linux/wait.h>

​

#include "pci.h"

​

/*

 * This interrupt-safe spinlock protects all accesses to PCI

 * configuration space.

 */

​

DEFINE_RAW_SPINLOCK(pci_lock);

​

/*

 * Wrappers for all PCI configuration access functions.  They just check

 * alignment, do locking and call the low-level functions pointed to

 * by pci_dev->ops.

 */

​

#define PCI_byte_BAD 0

#define PCI_word_BAD (pos & 1)

#define PCI_dword_BAD (pos & 3)

​

#ifdef CONFIG_PCI_LOCKLESS_CONFIG

# define pci_lock_config(f) do { (void)(f); } while (0)

# define pci_unlock_config(f)   do { (void)(f); } while (0)

#else

# define pci_lock_config(f) raw_spin_lock_irqsave(&pci_lock, f)

# define pci_unlock_config(f)   raw_spin_unlock_irqrestore(&pci_lock, f)

#endif

​

#define PCI_OP_READ(size, type, len) \

int noinline pci_bus_read_config_##size \

    (struct pci_bus *bus, unsigned int devfn, int pos, type *value) \

{                                   \

    int res;                            \

    unsigned long flags;                        \

    u32 data = 0;                           \

    if (PCI_##size##_BAD) return PCIBIOS_BAD_REGISTER_NUMBER;   \

    pci_lock_config(flags);                     \

    res = bus->ops->read(bus, devfn, pos, len, &data);      \

    *value = (type)data;                        \

    pci_unlock_config(flags);                   \

    return res;                         \

}

​

#define PCI_OP_WRITE(size, type, len) \

int noinline pci_bus_write_config_##size \

    (struct pci_bus *bus, unsigned int devfn, int pos, type value)  \

{                                   \

    int res;                            \

    unsigned long flags;                        \

    if (PCI_##size##_BAD) return PCIBIOS_BAD_REGISTER_NUMBER;   \

    pci_lock_config(flags);                     \

    res = bus->ops->write(bus, devfn, pos, len, value);     \

    pci_unlock_config(flags);                   \

    return res;                         \

}

​

PCI_OP_READ(byte, u8, 1)

PCI_OP_READ(word, u16, 2)

PCI_OP_READ(dword, u32, 4)

PCI_OP_WRITE(byte, u8, 1)

PCI_OP_WRITE(word, u16, 2)

PCI_OP_WRITE(dword, u32, 4)

​

EXPORT_SYMBOL(pci_bus_read_config_byte);

EXPORT_SYMBOL(pci_bus_read_config_word);

EXPORT_SYMBOL(pci_bus_read_config_dword);

EXPORT_SYMBOL(pci_bus_write_config_byte);

EXPORT_SYMBOL(pci_bus_write_config_word);

EXPORT_SYMBOL(pci_bus_write_config_dword);

​

int pci_generic_config_read(struct pci_bus *bus, unsigned int devfn,

                int where, int size, u32 *val)

{

    void __iomem *addr;

​

    addr = bus->ops->map_bus(bus, devfn, where);

    if (!addr) {

        *val = ~0;

        return PCIBIOS_DEVICE_NOT_FOUND;

    }

​

    if (size == 1)

        *val = readb(addr);

    else if (size == 2)

        *val = readw(addr);

    else