PCI: xgene: Convert to use generic config accessors
Convert the xgene host PCI driver to use the generic config access functions. Signed-off-by: Rob Herring <robh@kernel.org> Signed-off-by: Bjorn Helgaas <bhelgaas@google.com> CC: Tanmay Inamdar <tinamdar@apm.com> CC: linux-arm-kernel@lists.infradead.org
This commit is contained in:
parent
0e7ac8de01
commit
350f8be5bb
|
@ -74,92 +74,6 @@ static inline u32 pcie_bar_low_val(u32 addr, u32 flags)
|
||||||
return (addr & PCI_BASE_ADDRESS_MEM_MASK) | flags;
|
return (addr & PCI_BASE_ADDRESS_MEM_MASK) | flags;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* PCIe Configuration Out/In */
|
|
||||||
static inline void xgene_pcie_cfg_out32(void __iomem *addr, int offset, u32 val)
|
|
||||||
{
|
|
||||||
writel(val, addr + offset);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void xgene_pcie_cfg_out16(void __iomem *addr, int offset, u16 val)
|
|
||||||
{
|
|
||||||
u32 val32 = readl(addr + (offset & ~0x3));
|
|
||||||
|
|
||||||
switch (offset & 0x3) {
|
|
||||||
case 2:
|
|
||||||
val32 &= ~0xFFFF0000;
|
|
||||||
val32 |= (u32)val << 16;
|
|
||||||
break;
|
|
||||||
case 0:
|
|
||||||
default:
|
|
||||||
val32 &= ~0xFFFF;
|
|
||||||
val32 |= val;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
writel(val32, addr + (offset & ~0x3));
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void xgene_pcie_cfg_out8(void __iomem *addr, int offset, u8 val)
|
|
||||||
{
|
|
||||||
u32 val32 = readl(addr + (offset & ~0x3));
|
|
||||||
|
|
||||||
switch (offset & 0x3) {
|
|
||||||
case 0:
|
|
||||||
val32 &= ~0xFF;
|
|
||||||
val32 |= val;
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
val32 &= ~0xFF00;
|
|
||||||
val32 |= (u32)val << 8;
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
val32 &= ~0xFF0000;
|
|
||||||
val32 |= (u32)val << 16;
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
default:
|
|
||||||
val32 &= ~0xFF000000;
|
|
||||||
val32 |= (u32)val << 24;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
writel(val32, addr + (offset & ~0x3));
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void xgene_pcie_cfg_in32(void __iomem *addr, int offset, u32 *val)
|
|
||||||
{
|
|
||||||
*val = readl(addr + offset);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void xgene_pcie_cfg_in16(void __iomem *addr, int offset, u32 *val)
|
|
||||||
{
|
|
||||||
*val = readl(addr + (offset & ~0x3));
|
|
||||||
|
|
||||||
switch (offset & 0x3) {
|
|
||||||
case 2:
|
|
||||||
*val >>= 16;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
*val &= 0xFFFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void xgene_pcie_cfg_in8(void __iomem *addr, int offset, u32 *val)
|
|
||||||
{
|
|
||||||
*val = readl(addr + (offset & ~0x3));
|
|
||||||
|
|
||||||
switch (offset & 0x3) {
|
|
||||||
case 3:
|
|
||||||
*val = *val >> 24;
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
*val = *val >> 16;
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
*val = *val >> 8;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
*val &= 0xFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* When the address bit [17:16] is 2'b01, the Configuration access will be
|
* When the address bit [17:16] is 2'b01, the Configuration access will be
|
||||||
* treated as Type 1 and it will be forwarded to external PCIe device.
|
* treated as Type 1 and it will be forwarded to external PCIe device.
|
||||||
|
@ -213,69 +127,23 @@ static bool xgene_pcie_hide_rc_bars(struct pci_bus *bus, int offset)
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int xgene_pcie_read_config(struct pci_bus *bus, unsigned int devfn,
|
static int xgene_pcie_map_bus(struct pci_bus *bus, unsigned int devfn,
|
||||||
int offset, int len, u32 *val)
|
int offset)
|
||||||
{
|
{
|
||||||
struct xgene_pcie_port *port = bus->sysdata;
|
struct xgene_pcie_port *port = bus->sysdata;
|
||||||
void __iomem *addr;
|
|
||||||
|
|
||||||
if ((pci_is_root_bus(bus) && devfn != 0) || !port->link_up)
|
if ((pci_is_root_bus(bus) && devfn != 0) || !port->link_up ||
|
||||||
return PCIBIOS_DEVICE_NOT_FOUND;
|
xgene_pcie_hide_rc_bars(bus, offset))
|
||||||
|
return NULL;
|
||||||
if (xgene_pcie_hide_rc_bars(bus, offset)) {
|
|
||||||
*val = 0;
|
|
||||||
return PCIBIOS_SUCCESSFUL;
|
|
||||||
}
|
|
||||||
|
|
||||||
xgene_pcie_set_rtdid_reg(bus, devfn);
|
xgene_pcie_set_rtdid_reg(bus, devfn);
|
||||||
addr = xgene_pcie_get_cfg_base(bus);
|
return xgene_pcie_get_cfg_base(bus);
|
||||||
switch (len) {
|
|
||||||
case 1:
|
|
||||||
xgene_pcie_cfg_in8(addr, offset, val);
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
xgene_pcie_cfg_in16(addr, offset, val);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
xgene_pcie_cfg_in32(addr, offset, val);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
return PCIBIOS_SUCCESSFUL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int xgene_pcie_write_config(struct pci_bus *bus, unsigned int devfn,
|
|
||||||
int offset, int len, u32 val)
|
|
||||||
{
|
|
||||||
struct xgene_pcie_port *port = bus->sysdata;
|
|
||||||
void __iomem *addr;
|
|
||||||
|
|
||||||
if ((pci_is_root_bus(bus) && devfn != 0) || !port->link_up)
|
|
||||||
return PCIBIOS_DEVICE_NOT_FOUND;
|
|
||||||
|
|
||||||
if (xgene_pcie_hide_rc_bars(bus, offset))
|
|
||||||
return PCIBIOS_SUCCESSFUL;
|
|
||||||
|
|
||||||
xgene_pcie_set_rtdid_reg(bus, devfn);
|
|
||||||
addr = xgene_pcie_get_cfg_base(bus);
|
|
||||||
switch (len) {
|
|
||||||
case 1:
|
|
||||||
xgene_pcie_cfg_out8(addr, offset, (u8)val);
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
xgene_pcie_cfg_out16(addr, offset, (u16)val);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
xgene_pcie_cfg_out32(addr, offset, val);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
return PCIBIOS_SUCCESSFUL;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct pci_ops xgene_pcie_ops = {
|
static struct pci_ops xgene_pcie_ops = {
|
||||||
.read = xgene_pcie_read_config,
|
.map_bus = xgene_pcie_map_bus,
|
||||||
.write = xgene_pcie_write_config
|
.read = pci_generic_config_read32,
|
||||||
|
.write = pci_generic_config_write32,
|
||||||
};
|
};
|
||||||
|
|
||||||
static u64 xgene_pcie_set_ib_mask(void __iomem *csr_base, u32 addr,
|
static u64 xgene_pcie_set_ib_mask(void __iomem *csr_base, u32 addr,
|
||||||
|
|
Loading…
Reference in New Issue