forked from Minki/linux
3282636871
The mask value was calculated incorrectly for PCIEPAMR register if the size was less than 128 bytes. Fix this issue by adding a check on size. Link: https://lore.kernel.org/r/1588854799-13710-4-git-send-email-prabhakar.mahadev-lad.rj@bp.renesas.com Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> Signed-off-by: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com> Reviewed-by: Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
121 lines
2.8 KiB
C
121 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* PCIe driver for Renesas R-Car SoCs
|
|
* Copyright (C) 2014-2020 Renesas Electronics Europe Ltd
|
|
*
|
|
* Author: Phil Edworthy <phil.edworthy@renesas.com>
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/pci.h>
|
|
|
|
#include "pcie-rcar.h"
|
|
|
|
void rcar_pci_write_reg(struct rcar_pcie *pcie, u32 val, unsigned int reg)
|
|
{
|
|
writel(val, pcie->base + reg);
|
|
}
|
|
|
|
u32 rcar_pci_read_reg(struct rcar_pcie *pcie, unsigned int reg)
|
|
{
|
|
return readl(pcie->base + reg);
|
|
}
|
|
|
|
void rcar_rmw32(struct rcar_pcie *pcie, int where, u32 mask, u32 data)
|
|
{
|
|
unsigned int shift = BITS_PER_BYTE * (where & 3);
|
|
u32 val = rcar_pci_read_reg(pcie, where & ~3);
|
|
|
|
val &= ~(mask << shift);
|
|
val |= data << shift;
|
|
rcar_pci_write_reg(pcie, val, where & ~3);
|
|
}
|
|
|
|
int rcar_pcie_wait_for_phyrdy(struct rcar_pcie *pcie)
|
|
{
|
|
unsigned int timeout = 10;
|
|
|
|
while (timeout--) {
|
|
if (rcar_pci_read_reg(pcie, PCIEPHYSR) & PHYRDY)
|
|
return 0;
|
|
|
|
msleep(5);
|
|
}
|
|
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
int rcar_pcie_wait_for_dl(struct rcar_pcie *pcie)
|
|
{
|
|
unsigned int timeout = 10000;
|
|
|
|
while (timeout--) {
|
|
if ((rcar_pci_read_reg(pcie, PCIETSTR) & DATA_LINK_ACTIVE))
|
|
return 0;
|
|
|
|
udelay(5);
|
|
cpu_relax();
|
|
}
|
|
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
void rcar_pcie_set_outbound(struct rcar_pcie *pcie, int win,
|
|
struct resource_entry *window)
|
|
{
|
|
/* Setup PCIe address space mappings for each resource */
|
|
struct resource *res = window->res;
|
|
resource_size_t res_start;
|
|
resource_size_t size;
|
|
u32 mask;
|
|
|
|
rcar_pci_write_reg(pcie, 0x00000000, PCIEPTCTLR(win));
|
|
|
|
/*
|
|
* The PAMR mask is calculated in units of 128Bytes, which
|
|
* keeps things pretty simple.
|
|
*/
|
|
size = resource_size(res);
|
|
if (size > 128)
|
|
mask = (roundup_pow_of_two(size) / SZ_128) - 1;
|
|
else
|
|
mask = 0x0;
|
|
rcar_pci_write_reg(pcie, mask << 7, PCIEPAMR(win));
|
|
|
|
if (res->flags & IORESOURCE_IO)
|
|
res_start = pci_pio_to_address(res->start) - window->offset;
|
|
else
|
|
res_start = res->start - window->offset;
|
|
|
|
rcar_pci_write_reg(pcie, upper_32_bits(res_start), PCIEPAUR(win));
|
|
rcar_pci_write_reg(pcie, lower_32_bits(res_start) & ~0x7F,
|
|
PCIEPALR(win));
|
|
|
|
/* First resource is for IO */
|
|
mask = PAR_ENABLE;
|
|
if (res->flags & IORESOURCE_IO)
|
|
mask |= IO_SPACE;
|
|
|
|
rcar_pci_write_reg(pcie, mask, PCIEPTCTLR(win));
|
|
}
|
|
|
|
void rcar_pcie_set_inbound(struct rcar_pcie *pcie, u64 cpu_addr,
|
|
u64 pci_addr, u64 flags, int idx, bool host)
|
|
{
|
|
/*
|
|
* Set up 64-bit inbound regions as the range parser doesn't
|
|
* distinguish between 32 and 64-bit types.
|
|
*/
|
|
if (host)
|
|
rcar_pci_write_reg(pcie, lower_32_bits(pci_addr),
|
|
PCIEPRAR(idx));
|
|
rcar_pci_write_reg(pcie, lower_32_bits(cpu_addr), PCIELAR(idx));
|
|
rcar_pci_write_reg(pcie, flags, PCIELAMR(idx));
|
|
|
|
if (host)
|
|
rcar_pci_write_reg(pcie, upper_32_bits(pci_addr),
|
|
PCIEPRAR(idx + 1));
|
|
rcar_pci_write_reg(pcie, upper_32_bits(cpu_addr), PCIELAR(idx + 1));
|
|
rcar_pci_write_reg(pcie, 0, PCIELAMR(idx + 1));
|
|
}
|