|
@@ -80,14 +80,14 @@ static inline struct pcie_port *sys_to_pcie(struct pci_sys_data *sys)
|
|
|
return sys->private_data;
|
|
|
}
|
|
|
|
|
|
-int dw_pcie_cfg_read(void __iomem *addr, int where, int size, u32 *val)
|
|
|
+int dw_pcie_cfg_read(void __iomem *addr, int size, u32 *val)
|
|
|
{
|
|
|
if (size == 4)
|
|
|
*val = readl(addr);
|
|
|
else if (size == 2)
|
|
|
- *val = readw(addr + (where & 2));
|
|
|
+ *val = readw(addr);
|
|
|
else if (size == 1)
|
|
|
- *val = readb(addr + (where & 1));
|
|
|
+ *val = readb(addr);
|
|
|
else {
|
|
|
*val = 0;
|
|
|
return PCIBIOS_BAD_REGISTER_NUMBER;
|
|
@@ -96,14 +96,14 @@ int dw_pcie_cfg_read(void __iomem *addr, int where, int size, u32 *val)
|
|
|
return PCIBIOS_SUCCESSFUL;
|
|
|
}
|
|
|
|
|
|
-int dw_pcie_cfg_write(void __iomem *addr, int where, int size, u32 val)
|
|
|
+int dw_pcie_cfg_write(void __iomem *addr, int size, u32 val)
|
|
|
{
|
|
|
if (size == 4)
|
|
|
writel(val, addr);
|
|
|
else if (size == 2)
|
|
|
- writew(val, addr + (where & 2));
|
|
|
+ writew(val, addr);
|
|
|
else if (size == 1)
|
|
|
- writeb(val, addr + (where & 3));
|
|
|
+ writeb(val, addr);
|
|
|
else
|
|
|
return PCIBIOS_BAD_REGISTER_NUMBER;
|
|
|
|
|
@@ -134,8 +134,7 @@ static int dw_pcie_rd_own_conf(struct pcie_port *pp, int where, int size,
|
|
|
if (pp->ops->rd_own_conf)
|
|
|
ret = pp->ops->rd_own_conf(pp, where, size, val);
|
|
|
else
|
|
|
- ret = dw_pcie_cfg_read(pp->dbi_base + (where & ~0x3), where,
|
|
|
- size, val);
|
|
|
+ ret = dw_pcie_cfg_read(pp->dbi_base + where, size, val);
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
@@ -148,8 +147,7 @@ static int dw_pcie_wr_own_conf(struct pcie_port *pp, int where, int size,
|
|
|
if (pp->ops->wr_own_conf)
|
|
|
ret = pp->ops->wr_own_conf(pp, where, size, val);
|
|
|
else
|
|
|
- ret = dw_pcie_cfg_write(pp->dbi_base + (where & ~0x3), where,
|
|
|
- size, val);
|
|
|
+ ret = dw_pcie_cfg_write(pp->dbi_base + where, size, val);
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
@@ -585,13 +583,12 @@ static int dw_pcie_rd_other_conf(struct pcie_port *pp, struct pci_bus *bus,
|
|
|
u32 devfn, int where, int size, u32 *val)
|
|
|
{
|
|
|
int ret, type;
|
|
|
- u32 address, busdev, cfg_size;
|
|
|
+ u32 busdev, cfg_size;
|
|
|
u64 cpu_addr;
|
|
|
void __iomem *va_cfg_base;
|
|
|
|
|
|
busdev = PCIE_ATU_BUS(bus->number) | PCIE_ATU_DEV(PCI_SLOT(devfn)) |
|
|
|
PCIE_ATU_FUNC(PCI_FUNC(devfn));
|
|
|
- address = where & ~0x3;
|
|
|
|
|
|
if (bus->parent->number == pp->root_bus_nr) {
|
|
|
type = PCIE_ATU_TYPE_CFG0;
|
|
@@ -608,7 +605,7 @@ static int dw_pcie_rd_other_conf(struct pcie_port *pp, struct pci_bus *bus,
|
|
|
dw_pcie_prog_outbound_atu(pp, PCIE_ATU_REGION_INDEX0,
|
|
|
type, cpu_addr,
|
|
|
busdev, cfg_size);
|
|
|
- ret = dw_pcie_cfg_read(va_cfg_base + address, where, size, val);
|
|
|
+ ret = dw_pcie_cfg_read(va_cfg_base + where, size, val);
|
|
|
dw_pcie_prog_outbound_atu(pp, PCIE_ATU_REGION_INDEX0,
|
|
|
PCIE_ATU_TYPE_IO, pp->io_mod_base,
|
|
|
pp->io_bus_addr, pp->io_size);
|
|
@@ -620,13 +617,12 @@ static int dw_pcie_wr_other_conf(struct pcie_port *pp, struct pci_bus *bus,
|
|
|
u32 devfn, int where, int size, u32 val)
|
|
|
{
|
|
|
int ret, type;
|
|
|
- u32 address, busdev, cfg_size;
|
|
|
+ u32 busdev, cfg_size;
|
|
|
u64 cpu_addr;
|
|
|
void __iomem *va_cfg_base;
|
|
|
|
|
|
busdev = PCIE_ATU_BUS(bus->number) | PCIE_ATU_DEV(PCI_SLOT(devfn)) |
|
|
|
PCIE_ATU_FUNC(PCI_FUNC(devfn));
|
|
|
- address = where & ~0x3;
|
|
|
|
|
|
if (bus->parent->number == pp->root_bus_nr) {
|
|
|
type = PCIE_ATU_TYPE_CFG0;
|
|
@@ -643,7 +639,7 @@ static int dw_pcie_wr_other_conf(struct pcie_port *pp, struct pci_bus *bus,
|
|
|
dw_pcie_prog_outbound_atu(pp, PCIE_ATU_REGION_INDEX0,
|
|
|
type, cpu_addr,
|
|
|
busdev, cfg_size);
|
|
|
- ret = dw_pcie_cfg_write(va_cfg_base + address, where, size, val);
|
|
|
+ ret = dw_pcie_cfg_write(va_cfg_base + where, size, val);
|
|
|
dw_pcie_prog_outbound_atu(pp, PCIE_ATU_REGION_INDEX0,
|
|
|
PCIE_ATU_TYPE_IO, pp->io_mod_base,
|
|
|
pp->io_bus_addr, pp->io_size);
|