[mirror_ubuntu-eoan-kernel.git] / drivers / pci / host / pci-keystone.c

/*
 * PCIe host controller driver for Texas Instruments Keystone SoCs
 *
 * Copyright (C) 2013-2014 Texas Instruments., Ltd.
 *		http://www.ti.com
 *
 * Author: Murali Karicheri <m-karicheri2@ti.com>
 * Implementation based on pci-exynos.c and pcie-designware.c
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/irqchip/chained_irq.h>
#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/irqdomain.h>
#include <linux/init.h>
#include <linux/msi.h>
#include <linux/of_irq.h>
#include <linux/of.h>
#include <linux/of_pci.h>
#include <linux/platform_device.h>
#include <linux/phy/phy.h>
#include <linux/resource.h>
#include <linux/signal.h>

#include "pcie-designware.h"
#include "pci-keystone.h"

#define DRIVER_NAME	"keystone-pcie"

/* driver specific constants */
#define MAX_MSI_HOST_IRQS		8
#define MAX_LEGACY_HOST_IRQS		4

/* DEV_STAT_CTRL */
#define PCIE_CAP_BASE		0x70

/* PCIE controller device IDs */
#define PCIE_RC_K2HK		0xb008
#define PCIE_RC_K2E		0xb009
#define PCIE_RC_K2L		0xb00a

#define to_keystone_pcie(x)	container_of(x, struct keystone_pcie, pp)

static void quirk_limit_mrrs(struct pci_dev *dev)
{
	struct pci_bus *bus = dev->bus;
	struct pci_dev *bridge = bus->self;
	static const struct pci_device_id rc_pci_devids[] = {
		{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2HK),
		 .class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
		{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2E),
		 .class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
		{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2L),
		 .class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
		{ 0, },
	};

	if (pci_is_root_bus(bus))
		return;

	/* look for the host bridge */
	while (!pci_is_root_bus(bus)) {
		bridge = bus->self;
		bus = bus->parent;
	}

	if (bridge) {
		/*
		 * Keystone PCI controller has a h/w limitation of
		 * 256 bytes maximum read request size.  It can't handle
		 * anything higher than this.  So force this limit on
		 * all downstream devices.
		 */
		if (pci_match_id(rc_pci_devids, bridge)) {
			if (pcie_get_readrq(dev) > 256) {
				dev_info(&dev->dev, "limiting MRRS to 256\n");
				pcie_set_readrq(dev, 256);
			}
		}
	}
}
DECLARE_PCI_FIXUP_ENABLE(PCI_ANY_ID, PCI_ANY_ID, quirk_limit_mrrs);

static int ks_pcie_establish_link(struct keystone_pcie *ks_pcie)
{
	struct pcie_port *pp = &ks_pcie->pp;
	struct device *dev = pp->dev;
	unsigned int retries;

	dw_pcie_setup_rc(pp);

	if (dw_pcie_link_up(pp)) {
		dev_err(dev, "Link already up\n");
		return 0;
	}

	/* check if the link is up or not */
	for (retries = 0; retries < 5; retries++) {
		ks_dw_pcie_initiate_link_train(ks_pcie);
		if (!dw_pcie_wait_for_link(pp))
			return 0;
	}

	dev_err(dev, "phy link never came up\n");
	return -ETIMEDOUT;
}

static void ks_pcie_msi_irq_handler(struct irq_desc *desc)
{
	unsigned int irq = irq_desc_get_irq(desc);
	struct keystone_pcie *ks_pcie = irq_desc_get_handler_data(desc);
	u32 offset = irq - ks_pcie->msi_host_irqs[0];
	struct pcie_port *pp = &ks_pcie->pp;
	struct device *dev = pp->dev;
	struct irq_chip *chip = irq_desc_get_chip(desc);

	dev_dbg(dev, "%s, irq %d\n", __func__, irq);

	/*
	 * The chained irq handler installation would have replaced normal
	 * interrupt driver handler so we need to take care of mask/unmask and
	 * ack operation.
	 */
	chained_irq_enter(chip, desc);
	ks_dw_pcie_handle_msi_irq(ks_pcie, offset);
	chained_irq_exit(chip, desc);
}

/**
 * ks_pcie_legacy_irq_handler() - Handle legacy interrupt
 * @irq: IRQ line for legacy interrupts
 * @desc: Pointer to irq descriptor
 *
 * Traverse through pending legacy interrupts and invoke handler for each. Also
 * takes care of interrupt controller level mask/ack operation.
 */
static void ks_pcie_legacy_irq_handler(struct irq_desc *desc)
{
	unsigned int irq = irq_desc_get_irq(desc);
	struct keystone_pcie *ks_pcie = irq_desc_get_handler_data(desc);
	struct pcie_port *pp = &ks_pcie->pp;
	struct device *dev = pp->dev;
	u32 irq_offset = irq - ks_pcie->legacy_host_irqs[0];
	struct irq_chip *chip = irq_desc_get_chip(desc);

	dev_dbg(dev, ": Handling legacy irq %d\n", irq);

	/*
	 * The chained irq handler installation would have replaced normal
	 * interrupt driver handler so we need to take care of mask/unmask and
	 * ack operation.
	 */
	chained_irq_enter(chip, desc);
	ks_dw_pcie_handle_legacy_irq(ks_pcie, irq_offset);
	chained_irq_exit(chip, desc);
}

static int ks_pcie_get_irq_controller_info(struct keystone_pcie *ks_pcie,
					   char *controller, int *num_irqs)
{
	int temp, max_host_irqs, legacy = 1, *host_irqs;
	struct device *dev = ks_pcie->pp.dev;
	struct device_node *np_pcie = dev->of_node, **np_temp;

	if (!strcmp(controller, "msi-interrupt-controller"))
		legacy = 0;

	if (legacy) {
		np_temp = &ks_pcie->legacy_intc_np;
		max_host_irqs = MAX_LEGACY_HOST_IRQS;
		host_irqs = &ks_pcie->legacy_host_irqs[0];
	} else {
		np_temp = &ks_pcie->msi_intc_np;
		max_host_irqs = MAX_MSI_HOST_IRQS;
		host_irqs =  &ks_pcie->msi_host_irqs[0];
	}

	/* interrupt controller is in a child node */
	*np_temp = of_find_node_by_name(np_pcie, controller);
	if (!(*np_temp)) {
		dev_err(dev, "Node for %s is absent\n", controller);
		return -EINVAL;
	}

	temp = of_irq_count(*np_temp);
	if (!temp) {
		dev_err(dev, "No IRQ entries in %s\n", controller);
		return -EINVAL;
	}

	if (temp > max_host_irqs)
		dev_warn(dev, "Too many %s interrupts defined %u\n",
			(legacy ? "legacy" : "MSI"), temp);

	/*
	 * support upto max_host_irqs. In dt from index 0 to 3 (legacy) or 0 to
	 * 7 (MSI)
	 */
	for (temp = 0; temp < max_host_irqs; temp++) {
		host_irqs[temp] = irq_of_parse_and_map(*np_temp, temp);
		if (!host_irqs[temp])
			break;
	}

	if (temp) {
		*num_irqs = temp;
		return 0;
	}

	return -EINVAL;
}

static void ks_pcie_setup_interrupts(struct keystone_pcie *ks_pcie)
{
	int i;

	/* Legacy IRQ */
	for (i = 0; i < ks_pcie->num_legacy_host_irqs; i++) {
		irq_set_chained_handler_and_data(ks_pcie->legacy_host_irqs[i],
						 ks_pcie_legacy_irq_handler,
						 ks_pcie);
	}
	ks_dw_pcie_enable_legacy_irqs(ks_pcie);

	/* MSI IRQ */
	if (IS_ENABLED(CONFIG_PCI_MSI)) {
		for (i = 0; i < ks_pcie->num_msi_host_irqs; i++) {
			irq_set_chained_handler_and_data(ks_pcie->msi_host_irqs[i],
							 ks_pcie_msi_irq_handler,
							 ks_pcie);
		}
	}

	if (ks_pcie->error_irq > 0)
		ks_dw_pcie_enable_error_irq(ks_pcie);
}

/*
 * When a PCI device does not exist during config cycles, keystone host gets a
 * bus error instead of returning 0xffffffff. This handler always returns 0
 * for this kind of faults.
 */
static int keystone_pcie_fault(unsigned long addr, unsigned int fsr,
				struct pt_regs *regs)
{
	unsigned long instr = *(unsigned long *) instruction_pointer(regs);

	if ((instr & 0x0e100090) == 0x00100090) {
		int reg = (instr >> 12) & 15;

		regs->uregs[reg] = -1;
		regs->ARM_pc += 4;
	}

	return 0;
}

static void __init ks_pcie_host_init(struct pcie_port *pp)
{
	struct keystone_pcie *ks_pcie = to_keystone_pcie(pp);
	u32 val;

	ks_pcie_establish_link(ks_pcie);
	ks_dw_pcie_setup_rc_app_regs(ks_pcie);
	ks_pcie_setup_interrupts(ks_pcie);
	writew(PCI_IO_RANGE_TYPE_32 | (PCI_IO_RANGE_TYPE_32 << 8),
			pp->dbi_base + PCI_IO_BASE);

	/* update the Vendor ID */
	writew(ks_pcie->device_id, pp->dbi_base + PCI_DEVICE_ID);

	/* update the DEV_STAT_CTRL to publish right mrrs */
	val = readl(pp->dbi_base + PCIE_CAP_BASE + PCI_EXP_DEVCTL);
	val &= ~PCI_EXP_DEVCTL_READRQ;
	/* set the mrrs to 256 bytes */
	val |= BIT(12);
	writel(val, pp->dbi_base + PCIE_CAP_BASE + PCI_EXP_DEVCTL);

	/*
	 * PCIe access errors that result into OCP errors are caught by ARM as
	 * "External aborts"
	 */
	hook_fault_code(17, keystone_pcie_fault, SIGBUS, 0,
			"Asynchronous external abort");
}

static struct pcie_host_ops keystone_pcie_host_ops = {
	.rd_other_conf = ks_dw_pcie_rd_other_conf,
	.wr_other_conf = ks_dw_pcie_wr_other_conf,
	.link_up = ks_dw_pcie_link_up,
	.host_init = ks_pcie_host_init,
	.msi_set_irq = ks_dw_pcie_msi_set_irq,
	.msi_clear_irq = ks_dw_pcie_msi_clear_irq,
	.get_msi_addr = ks_dw_pcie_get_msi_addr,
	.msi_host_init = ks_dw_pcie_msi_host_init,
	.scan_bus = ks_dw_pcie_v3_65_scan_bus,
};

static irqreturn_t pcie_err_irq_handler(int irq, void *priv)
{
	struct keystone_pcie *ks_pcie = priv;

	return ks_dw_pcie_handle_error_irq(ks_pcie);
}

static int __init ks_add_pcie_port(struct keystone_pcie *ks_pcie,
			 struct platform_device *pdev)
{
	struct pcie_port *pp = &ks_pcie->pp;
	struct device *dev = pp->dev;
	int ret;

	ret = ks_pcie_get_irq_controller_info(ks_pcie,
					"legacy-interrupt-controller",
					&ks_pcie->num_legacy_host_irqs);
	if (ret)
		return ret;

	if (IS_ENABLED(CONFIG_PCI_MSI)) {
		ret = ks_pcie_get_irq_controller_info(ks_pcie,
						"msi-interrupt-controller",
						&ks_pcie->num_msi_host_irqs);
		if (ret)
			return ret;
	}

	/*
	 * Index 0 is the platform interrupt for error interrupt
	 * from RC.  This is optional.
	 */
	ks_pcie->error_irq = irq_of_parse_and_map(ks_pcie->np, 0);
	if (ks_pcie->error_irq <= 0)
		dev_info(dev, "no error IRQ defined\n");
	else {
		ret = request_irq(ks_pcie->error_irq, pcie_err_irq_handler,
				  IRQF_SHARED, "pcie-error-irq", ks_pcie);
		if (ret < 0) {
			dev_err(dev, "failed to request error IRQ %d\n",
				ks_pcie->error_irq);
			return ret;
		}
	}

	pp->root_bus_nr = -1;
	pp->ops = &keystone_pcie_host_ops;
	ret = ks_dw_pcie_host_init(ks_pcie, ks_pcie->msi_intc_np);
	if (ret) {
		dev_err(dev, "failed to initialize host\n");
		return ret;
	}

	return 0;
}

static const struct of_device_id ks_pcie_of_match[] = {
	{
		.type = "pci",
		.compatible = "ti,keystone-pcie",
	},
	{ },
};

static int __exit ks_pcie_remove(struct platform_device *pdev)
{
	struct keystone_pcie *ks_pcie = platform_get_drvdata(pdev);

	clk_disable_unprepare(ks_pcie->clk);

	return 0;
}

static int __init ks_pcie_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct keystone_pcie *ks_pcie;
	struct pcie_port *pp;
	struct resource *res;
	void __iomem *reg_p;
	struct phy *phy;
	int ret;

	ks_pcie = devm_kzalloc(dev, sizeof(*ks_pcie), GFP_KERNEL);
	if (!ks_pcie)
		return -ENOMEM;

	pp = &ks_pcie->pp;
	pp->dev = dev;

	/* initialize SerDes Phy if present */
	phy = devm_phy_get(dev, "pcie-phy");
	if (PTR_ERR_OR_ZERO(phy) == -EPROBE_DEFER)
		return PTR_ERR(phy);

	if (!IS_ERR_OR_NULL(phy)) {
		ret = phy_init(phy);
		if (ret < 0)
			return ret;
	}

	/* index 2 is to read PCI DEVICE_ID */
	res = platform_get_resource(pdev, IORESOURCE_MEM, 2);
	reg_p = devm_ioremap_resource(dev, res);
	if (IS_ERR(reg_p))
		return PTR_ERR(reg_p);
	ks_pcie->device_id = readl(reg_p) >> 16;
	devm_iounmap(dev, reg_p);
	devm_release_mem_region(dev, res->start, resource_size(res));

	ks_pcie->np = dev->of_node;
	platform_set_drvdata(pdev, ks_pcie);
	ks_pcie->clk = devm_clk_get(dev, "pcie");
	if (IS_ERR(ks_pcie->clk)) {
		dev_err(dev, "Failed to get pcie rc clock\n");
		return PTR_ERR(ks_pcie->clk);
	}
	ret = clk_prepare_enable(ks_pcie->clk);
	if (ret)
		return ret;

	ret = ks_add_pcie_port(ks_pcie, pdev);
	if (ret < 0)
		goto fail_clk;

	return 0;
fail_clk:
	clk_disable_unprepare(ks_pcie->clk);

	return ret;
}

static struct platform_driver ks_pcie_driver __refdata = {
	.probe  = ks_pcie_probe,
	.remove = __exit_p(ks_pcie_remove),
	.driver = {
		.name	= "keystone-pcie",
		.of_match_table = of_match_ptr(ks_pcie_of_match),
	},
};
builtin_platform_driver(ks_pcie_driver);
Commit	Line	Data
0c4ffcfe MK	1	/*
	2	* PCIe host controller driver for Texas Instruments Keystone SoCs
	3	*
	4	* Copyright (C) 2013-2014 Texas Instruments., Ltd.
	5	* http://www.ti.com
	6	*
	7	* Author: Murali Karicheri <m-karicheri2@ti.com>
	8	* Implementation based on pci-exynos.c and pcie-designware.c
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License version 2 as
	12	* published by the Free Software Foundation.
	13	*/
	14
	15	#include <linux/irqchip/chained_irq.h>
	16	#include <linux/clk.h>
	17	#include <linux/delay.h>
025dd3da	18	#include <linux/interrupt.h>
0c4ffcfe	19	#include <linux/irqdomain.h>
1481bf21	20	#include <linux/init.h>
0c4ffcfe MK	21	#include <linux/msi.h>
	22	#include <linux/of_irq.h>
	23	#include <linux/of.h>
	24	#include <linux/of_pci.h>
	25	#include <linux/platform_device.h>
	26	#include <linux/phy/phy.h>
	27	#include <linux/resource.h>
	28	#include <linux/signal.h>
	29
	30	#include "pcie-designware.h"
	31	#include "pci-keystone.h"
	32
	33	#define DRIVER_NAME "keystone-pcie"
	34
	35	/* driver specific constants */
	36	#define MAX_MSI_HOST_IRQS 8
	37	#define MAX_LEGACY_HOST_IRQS 4
	38
0c4ffcfe MK	39	/* DEV_STAT_CTRL */
	40	#define PCIE_CAP_BASE 0x70
	41
c15982df MK	42	/* PCIE controller device IDs */
	43	#define PCIE_RC_K2HK 0xb008
	44	#define PCIE_RC_K2E 0xb009
	45	#define PCIE_RC_K2L 0xb00a
	46
0c4ffcfe MK	47	#define to_keystone_pcie(x) container_of(x, struct keystone_pcie, pp)
0c4ffcfe MK	48
c15982df MK	49	static void quirk_limit_mrrs(struct pci_dev *dev)
	50	{
	51	struct pci_bus *bus = dev->bus;
	52	struct pci_dev *bridge = bus->self;
	53	static const struct pci_device_id rc_pci_devids[] = {
	54	{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2HK),
	55	.class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
	56	{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2E),
	57	.class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
	58	{ PCI_DEVICE(PCI_VENDOR_ID_TI, PCIE_RC_K2L),
	59	.class = PCI_CLASS_BRIDGE_PCI << 8, .class_mask = ~0, },
	60	{ 0, },
	61	};
	62
	63	if (pci_is_root_bus(bus))
	64	return;
	65
	66	/* look for the host bridge */
	67	while (!pci_is_root_bus(bus)) {
	68	bridge = bus->self;
	69	bus = bus->parent;
	70	}
	71
	72	if (bridge) {
	73	/*
	74	* Keystone PCI controller has a h/w limitation of
	75	* 256 bytes maximum read request size. It can't handle
	76	* anything higher than this. So force this limit on
	77	* all downstream devices.
	78	*/
	79	if (pci_match_id(rc_pci_devids, bridge)) {
	80	if (pcie_get_readrq(dev) > 256) {
	81	dev_info(&dev->dev, "limiting MRRS to 256\n");
	82	pcie_set_readrq(dev, 256);
	83	}
	84	}
	85	}
	86	}
	87	DECLARE_PCI_FIXUP_ENABLE(PCI_ANY_ID, PCI_ANY_ID, quirk_limit_mrrs);
	88
0c4ffcfe MK	89	static int ks_pcie_establish_link(struct keystone_pcie *ks_pcie)
	90	{
	91	struct pcie_port *pp = &ks_pcie->pp;
21fa0c51	92	struct device *dev = pp->dev;
6cbb247e	93	unsigned int retries;
0c4ffcfe MK	94
	95	dw_pcie_setup_rc(pp);
	96
	97	if (dw_pcie_link_up(pp)) {
21fa0c51	98	dev_err(dev, "Link already up\n");
0c4ffcfe MK	99	return 0;
	100	}
	101
0c4ffcfe	102	/* check if the link is up or not */
886bc5ce	103	for (retries = 0; retries < 5; retries++) {
6cbb247e	104	ks_dw_pcie_initiate_link_train(ks_pcie);
886bc5ce JP	105	if (!dw_pcie_wait_for_link(pp))
886bc5ce JP	106	return 0;
0c4ffcfe MK	107	}
0c4ffcfe MK	108
21fa0c51	109	dev_err(dev, "phy link never came up\n");
886bc5ce	110	return -ETIMEDOUT;
0c4ffcfe MK	111	}
0c4ffcfe MK	112
bd0b9ac4	113	static void ks_pcie_msi_irq_handler(struct irq_desc *desc)
0c4ffcfe	114	{
97a85964	115	unsigned int irq = irq_desc_get_irq(desc);
0c4ffcfe MK	116	struct keystone_pcie *ks_pcie = irq_desc_get_handler_data(desc);
	117	u32 offset = irq - ks_pcie->msi_host_irqs[0];
	118	struct pcie_port *pp = &ks_pcie->pp;
21fa0c51	119	struct device *dev = pp->dev;
0c4ffcfe MK	120	struct irq_chip *chip = irq_desc_get_chip(desc);
0c4ffcfe MK	121
21fa0c51	122	dev_dbg(dev, "%s, irq %d\n", __func__, irq);
0c4ffcfe MK	123
	124	/*
	125	* The chained irq handler installation would have replaced normal
	126	* interrupt driver handler so we need to take care of mask/unmask and
	127	* ack operation.
	128	*/
	129	chained_irq_enter(chip, desc);
	130	ks_dw_pcie_handle_msi_irq(ks_pcie, offset);
	131	chained_irq_exit(chip, desc);
	132	}
	133
	134	/**
	135	* ks_pcie_legacy_irq_handler() - Handle legacy interrupt
	136	* @irq: IRQ line for legacy interrupts
	137	* @desc: Pointer to irq descriptor
	138	*
	139	* Traverse through pending legacy interrupts and invoke handler for each. Also
	140	* takes care of interrupt controller level mask/ack operation.
	141	*/
bd0b9ac4	142	static void ks_pcie_legacy_irq_handler(struct irq_desc *desc)
0c4ffcfe	143	{
97a85964	144	unsigned int irq = irq_desc_get_irq(desc);
0c4ffcfe MK	145	struct keystone_pcie *ks_pcie = irq_desc_get_handler_data(desc);
0c4ffcfe MK	146	struct pcie_port *pp = &ks_pcie->pp;
21fa0c51	147	struct device *dev = pp->dev;
0c4ffcfe MK	148	u32 irq_offset = irq - ks_pcie->legacy_host_irqs[0];
	149	struct irq_chip *chip = irq_desc_get_chip(desc);
	150
21fa0c51	151	dev_dbg(dev, ": Handling legacy irq %d\n", irq);
0c4ffcfe MK	152
	153	/*
	154	* The chained irq handler installation would have replaced normal
	155	* interrupt driver handler so we need to take care of mask/unmask and
	156	* ack operation.
	157	*/
	158	chained_irq_enter(chip, desc);
	159	ks_dw_pcie_handle_legacy_irq(ks_pcie, irq_offset);
	160	chained_irq_exit(chip, desc);
	161	}
	162
	163	static int ks_pcie_get_irq_controller_info(struct keystone_pcie *ks_pcie,
	164	char controller, int num_irqs)
	165	{
1e9f8dcf	166	int temp, max_host_irqs, legacy = 1, *host_irqs;
0c4ffcfe MK	167	struct device *dev = ks_pcie->pp.dev;
	168	struct device_node np_pcie = dev->of_node, *np_temp;
	169
	170	if (!strcmp(controller, "msi-interrupt-controller"))
	171	legacy = 0;
	172
	173	if (legacy) {
	174	np_temp = &ks_pcie->legacy_intc_np;
	175	max_host_irqs = MAX_LEGACY_HOST_IRQS;
	176	host_irqs = &ks_pcie->legacy_host_irqs[0];
	177	} else {
	178	np_temp = &ks_pcie->msi_intc_np;
	179	max_host_irqs = MAX_MSI_HOST_IRQS;
	180	host_irqs = &ks_pcie->msi_host_irqs[0];
	181	}
	182
	183	/* interrupt controller is in a child node */
	184	*np_temp = of_find_node_by_name(np_pcie, controller);
	185	if (!(*np_temp)) {
	186	dev_err(dev, "Node for %s is absent\n", controller);
1e9f8dcf	187	return -EINVAL;
0c4ffcfe	188	}
1e9f8dcf	189
0c4ffcfe	190	temp = of_irq_count(*np_temp);
1e9f8dcf MK	191	if (!temp) {
	192	dev_err(dev, "No IRQ entries in %s\n", controller);
	193	return -EINVAL;
	194	}
	195
0c4ffcfe MK	196	if (temp > max_host_irqs)
	197	dev_warn(dev, "Too many %s interrupts defined %u\n",
	198	(legacy ? "legacy" : "MSI"), temp);
	199
	200	/*
	201	* support upto max_host_irqs. In dt from index 0 to 3 (legacy) or 0 to
	202	* 7 (MSI)
	203	*/
	204	for (temp = 0; temp < max_host_irqs; temp++) {
	205	host_irqs[temp] = irq_of_parse_and_map(*np_temp, temp);
ea3651fe	206	if (!host_irqs[temp])
0c4ffcfe MK	207	break;
0c4ffcfe MK	208	}
1e9f8dcf	209
0c4ffcfe MK	210	if (temp) {
0c4ffcfe MK	211	*num_irqs = temp;
1e9f8dcf	212	return 0;
0c4ffcfe	213	}
1e9f8dcf MK	214
1e9f8dcf MK	215	return -EINVAL;
0c4ffcfe MK	216	}
	217
	218	static void ks_pcie_setup_interrupts(struct keystone_pcie *ks_pcie)
	219	{
	220	int i;
	221
	222	/* Legacy IRQ */
	223	for (i = 0; i < ks_pcie->num_legacy_host_irqs; i++) {
5168a73c TG	224	irq_set_chained_handler_and_data(ks_pcie->legacy_host_irqs[i],
	225	ks_pcie_legacy_irq_handler,
	226	ks_pcie);
0c4ffcfe MK	227	}
	228	ks_dw_pcie_enable_legacy_irqs(ks_pcie);
	229
	230	/* MSI IRQ */
	231	if (IS_ENABLED(CONFIG_PCI_MSI)) {
	232	for (i = 0; i < ks_pcie->num_msi_host_irqs; i++) {
2cf5a03c TG	233	irq_set_chained_handler_and_data(ks_pcie->msi_host_irqs[i],
	234	ks_pcie_msi_irq_handler,
	235	ks_pcie);
0c4ffcfe MK	236	}
0c4ffcfe MK	237	}
025dd3da MK	238
025dd3da MK	239	if (ks_pcie->error_irq > 0)
5649e4ce	240	ks_dw_pcie_enable_error_irq(ks_pcie);
0c4ffcfe MK	241	}
	242
	243	/*
	244	* When a PCI device does not exist during config cycles, keystone host gets a
	245	* bus error instead of returning 0xffffffff. This handler always returns 0
	246	* for this kind of faults.
	247	*/
	248	static int keystone_pcie_fault(unsigned long addr, unsigned int fsr,
	249	struct pt_regs *regs)
	250	{
	251	unsigned long instr = (unsigned long ) instruction_pointer(regs);
	252
	253	if ((instr & 0x0e100090) == 0x00100090) {
	254	int reg = (instr >> 12) & 15;
	255
	256	regs->uregs[reg] = -1;
	257	regs->ARM_pc += 4;
	258	}
	259
	260	return 0;
	261	}
	262
	263	static void __init ks_pcie_host_init(struct pcie_port *pp)
	264	{
0c4ffcfe	265	struct keystone_pcie *ks_pcie = to_keystone_pcie(pp);
8665a482	266	u32 val;
0c4ffcfe MK	267
	268	ks_pcie_establish_link(ks_pcie);
	269	ks_dw_pcie_setup_rc_app_regs(ks_pcie);
	270	ks_pcie_setup_interrupts(ks_pcie);
	271	writew(PCI_IO_RANGE_TYPE_32 \| (PCI_IO_RANGE_TYPE_32 << 8),
	272	pp->dbi_base + PCI_IO_BASE);
	273
	274	/* update the Vendor ID */
8665a482	275	writew(ks_pcie->device_id, pp->dbi_base + PCI_DEVICE_ID);
0c4ffcfe MK	276
	277	/* update the DEV_STAT_CTRL to publish right mrrs */
	278	val = readl(pp->dbi_base + PCIE_CAP_BASE + PCI_EXP_DEVCTL);
	279	val &= ~PCI_EXP_DEVCTL_READRQ;
	280	/* set the mrrs to 256 bytes */
	281	val \|= BIT(12);
	282	writel(val, pp->dbi_base + PCIE_CAP_BASE + PCI_EXP_DEVCTL);
	283
	284	/*
	285	* PCIe access errors that result into OCP errors are caught by ARM as
	286	* "External aborts"
	287	*/
	288	hook_fault_code(17, keystone_pcie_fault, SIGBUS, 0,
	289	"Asynchronous external abort");
	290	}
	291
	292	static struct pcie_host_ops keystone_pcie_host_ops = {
	293	.rd_other_conf = ks_dw_pcie_rd_other_conf,
	294	.wr_other_conf = ks_dw_pcie_wr_other_conf,
	295	.link_up = ks_dw_pcie_link_up,
	296	.host_init = ks_pcie_host_init,
	297	.msi_set_irq = ks_dw_pcie_msi_set_irq,
	298	.msi_clear_irq = ks_dw_pcie_msi_clear_irq,
1104528b	299	.get_msi_addr = ks_dw_pcie_get_msi_addr,
0c4ffcfe MK	300	.msi_host_init = ks_dw_pcie_msi_host_init,
	301	.scan_bus = ks_dw_pcie_v3_65_scan_bus,
	302	};
	303
025dd3da MK	304	static irqreturn_t pcie_err_irq_handler(int irq, void *priv)
	305	{
	306	struct keystone_pcie *ks_pcie = priv;
	307
5649e4ce	308	return ks_dw_pcie_handle_error_irq(ks_pcie);
025dd3da MK	309	}
025dd3da MK	310
0c4ffcfe MK	311	static int __init ks_add_pcie_port(struct keystone_pcie *ks_pcie,
	312	struct platform_device *pdev)
	313	{
	314	struct pcie_port *pp = &ks_pcie->pp;
21fa0c51	315	struct device *dev = pp->dev;
0c4ffcfe MK	316	int ret;
	317
	318	ret = ks_pcie_get_irq_controller_info(ks_pcie,
	319	"legacy-interrupt-controller",
	320	&ks_pcie->num_legacy_host_irqs);
	321	if (ret)
	322	return ret;
	323
	324	if (IS_ENABLED(CONFIG_PCI_MSI)) {
	325	ret = ks_pcie_get_irq_controller_info(ks_pcie,
	326	"msi-interrupt-controller",
	327	&ks_pcie->num_msi_host_irqs);
	328	if (ret)
	329	return ret;
	330	}
	331
025dd3da MK	332	/*
	333	* Index 0 is the platform interrupt for error interrupt
	334	* from RC. This is optional.
	335	*/
	336	ks_pcie->error_irq = irq_of_parse_and_map(ks_pcie->np, 0);
	337	if (ks_pcie->error_irq <= 0)
21fa0c51	338	dev_info(dev, "no error IRQ defined\n");
025dd3da	339	else {
8116acce WY	340	ret = request_irq(ks_pcie->error_irq, pcie_err_irq_handler,
	341	IRQF_SHARED, "pcie-error-irq", ks_pcie);
	342	if (ret < 0) {
21fa0c51	343	dev_err(dev, "failed to request error IRQ %d\n",
025dd3da MK	344	ks_pcie->error_irq);
	345	return ret;
	346	}
	347	}
	348
0c4ffcfe MK	349	pp->root_bus_nr = -1;
	350	pp->ops = &keystone_pcie_host_ops;
	351	ret = ks_dw_pcie_host_init(ks_pcie, ks_pcie->msi_intc_np);
	352	if (ret) {
21fa0c51	353	dev_err(dev, "failed to initialize host\n");
0c4ffcfe MK	354	return ret;
	355	}
	356
1e9f8dcf	357	return 0;
0c4ffcfe MK	358	}
	359
	360	static const struct of_device_id ks_pcie_of_match[] = {
	361	{
	362	.type = "pci",
	363	.compatible = "ti,keystone-pcie",
	364	},
	365	{ },
	366	};
0c4ffcfe MK	367
	368	static int __exit ks_pcie_remove(struct platform_device *pdev)
	369	{
	370	struct keystone_pcie *ks_pcie = platform_get_drvdata(pdev);
	371
	372	clk_disable_unprepare(ks_pcie->clk);
	373
	374	return 0;
	375	}
	376
	377	static int __init ks_pcie_probe(struct platform_device *pdev)
	378	{
	379	struct device *dev = &pdev->dev;
	380	struct keystone_pcie *ks_pcie;
	381	struct pcie_port *pp;
	382	struct resource *res;
	383	void __iomem *reg_p;
	384	struct phy *phy;
1e9f8dcf	385	int ret;
0c4ffcfe	386
21fa0c51	387	ks_pcie = devm_kzalloc(dev, sizeof(*ks_pcie), GFP_KERNEL);
66700707	388	if (!ks_pcie)
0c4ffcfe	389	return -ENOMEM;
66700707	390
0c4ffcfe	391	pp = &ks_pcie->pp;
21fa0c51	392	pp->dev = dev;
0c4ffcfe	393
0c4ffcfe MK	394	/* initialize SerDes Phy if present */
0c4ffcfe MK	395	phy = devm_phy_get(dev, "pcie-phy");
25de15c9 SL	396	if (PTR_ERR_OR_ZERO(phy) == -EPROBE_DEFER)
	397	return PTR_ERR(phy);
	398
0c4ffcfe MK	399	if (!IS_ERR_OR_NULL(phy)) {
	400	ret = phy_init(phy);
	401	if (ret < 0)
	402	return ret;
	403	}
	404
4455efc9 MK	405	/* index 2 is to read PCI DEVICE_ID */
4455efc9 MK	406	res = platform_get_resource(pdev, IORESOURCE_MEM, 2);
0c4ffcfe MK	407	reg_p = devm_ioremap_resource(dev, res);
	408	if (IS_ERR(reg_p))
	409	return PTR_ERR(reg_p);
8665a482 MK	410	ks_pcie->device_id = readl(reg_p) >> 16;
	411	devm_iounmap(dev, reg_p);
	412	devm_release_mem_region(dev, res->start, resource_size(res));
0c4ffcfe	413
025dd3da	414	ks_pcie->np = dev->of_node;
0c4ffcfe MK	415	platform_set_drvdata(pdev, ks_pcie);
	416	ks_pcie->clk = devm_clk_get(dev, "pcie");
	417	if (IS_ERR(ks_pcie->clk)) {
	418	dev_err(dev, "Failed to get pcie rc clock\n");
	419	return PTR_ERR(ks_pcie->clk);
	420	}
	421	ret = clk_prepare_enable(ks_pcie->clk);
	422	if (ret)
	423	return ret;
	424
	425	ret = ks_add_pcie_port(ks_pcie, pdev);
	426	if (ret < 0)
	427	goto fail_clk;
	428
	429	return 0;
	430	fail_clk:
	431	clk_disable_unprepare(ks_pcie->clk);
	432
	433	return ret;
	434	}
	435
	436	static struct platform_driver ks_pcie_driver __refdata = {
	437	.probe = ks_pcie_probe,
	438	.remove = __exit_p(ks_pcie_remove),
	439	.driver = {
	440	.name = "keystone-pcie",
0c4ffcfe MK	441	.of_match_table = of_match_ptr(ks_pcie_of_match),
	442	},
	443	};
1481bf21	444	builtin_platform_driver(ks_pcie_driver);