PCI: mediatek: Add loadable kernel module support

Implement remove() callback function for the Mediatek PCIe controller
driver to add loadable kernel module support.

Save the PCIe's GIC IRQ at probe so that it can be retrieved to
call dispose_irq() to tear down the IRQ upon module removal.

Signed-off-by: Honghui Zhang <honghui.zhang@mediatek.com>
[lorenzo.pieralisi@arm.com: updated commit log]
Signed-off-by: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com>
Reviewed-by: Ryder Lee <ryder.lee@mediatek.com>
This commit is contained in:
Honghui Zhang 2018-10-15 16:08:59 +08:00 committed by Lorenzo Pieralisi
parent 97d2932fee
commit 031337ace2
2 changed files with 57 additions and 5 deletions

View File

@ -231,7 +231,7 @@ config PCIE_ROCKCHIP_EP
available to support GEN2 with 4 slots. available to support GEN2 with 4 slots.
config PCIE_MEDIATEK config PCIE_MEDIATEK
bool "MediaTek PCIe controller" tristate "MediaTek PCIe controller"
depends on ARCH_MEDIATEK || COMPILE_TEST depends on ARCH_MEDIATEK || COMPILE_TEST
depends on OF depends on OF
depends on PCI_MSI_IRQ_DOMAIN depends on PCI_MSI_IRQ_DOMAIN

View File

@ -15,6 +15,7 @@
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/msi.h> #include <linux/msi.h>
#include <linux/module.h>
#include <linux/of_address.h> #include <linux/of_address.h>
#include <linux/of_pci.h> #include <linux/of_pci.h>
#include <linux/of_platform.h> #include <linux/of_platform.h>
@ -162,6 +163,7 @@ struct mtk_pcie_soc {
* @phy: pointer to PHY control block * @phy: pointer to PHY control block
* @lane: lane count * @lane: lane count
* @slot: port slot * @slot: port slot
* @irq: GIC irq
* @irq_domain: legacy INTx IRQ domain * @irq_domain: legacy INTx IRQ domain
* @inner_domain: inner IRQ domain * @inner_domain: inner IRQ domain
* @msi_domain: MSI IRQ domain * @msi_domain: MSI IRQ domain
@ -182,6 +184,7 @@ struct mtk_pcie_port {
struct phy *phy; struct phy *phy;
u32 lane; u32 lane;
u32 slot; u32 slot;
int irq;
struct irq_domain *irq_domain; struct irq_domain *irq_domain;
struct irq_domain *inner_domain; struct irq_domain *inner_domain;
struct irq_domain *msi_domain; struct irq_domain *msi_domain;
@ -530,6 +533,27 @@ static void mtk_pcie_enable_msi(struct mtk_pcie_port *port)
writel(val, port->base + PCIE_INT_MASK); writel(val, port->base + PCIE_INT_MASK);
} }
static void mtk_pcie_irq_teardown(struct mtk_pcie *pcie)
{
struct mtk_pcie_port *port, *tmp;
list_for_each_entry_safe(port, tmp, &pcie->ports, list) {
irq_set_chained_handler_and_data(port->irq, NULL, NULL);
if (port->irq_domain)
irq_domain_remove(port->irq_domain);
if (IS_ENABLED(CONFIG_PCI_MSI)) {
if (port->msi_domain)
irq_domain_remove(port->msi_domain);
if (port->inner_domain)
irq_domain_remove(port->inner_domain);
}
irq_dispose_mapping(port->irq);
}
}
static int mtk_pcie_intx_map(struct irq_domain *domain, unsigned int irq, static int mtk_pcie_intx_map(struct irq_domain *domain, unsigned int irq,
irq_hw_number_t hwirq) irq_hw_number_t hwirq)
{ {
@ -620,7 +644,7 @@ static int mtk_pcie_setup_irq(struct mtk_pcie_port *port,
struct mtk_pcie *pcie = port->pcie; struct mtk_pcie *pcie = port->pcie;
struct device *dev = pcie->dev; struct device *dev = pcie->dev;
struct platform_device *pdev = to_platform_device(dev); struct platform_device *pdev = to_platform_device(dev);
int err, irq; int err;
err = mtk_pcie_init_irq_domain(port, node); err = mtk_pcie_init_irq_domain(port, node);
if (err) { if (err) {
@ -628,8 +652,9 @@ static int mtk_pcie_setup_irq(struct mtk_pcie_port *port,
return err; return err;
} }
irq = platform_get_irq(pdev, port->slot); port->irq = platform_get_irq(pdev, port->slot);
irq_set_chained_handler_and_data(irq, mtk_pcie_intr_handler, port); irq_set_chained_handler_and_data(port->irq,
mtk_pcie_intr_handler, port);
return 0; return 0;
} }
@ -1168,6 +1193,31 @@ static int mtk_pcie_probe(struct platform_device *pdev)
return err; return err;
} }
static void mtk_pcie_free_resources(struct mtk_pcie *pcie)
{
struct pci_host_bridge *host = pci_host_bridge_from_priv(pcie);
struct list_head *windows = &host->windows;
pci_free_resource_list(windows);
}
static int mtk_pcie_remove(struct platform_device *pdev)
{
struct mtk_pcie *pcie = platform_get_drvdata(pdev);
struct pci_host_bridge *host = pci_host_bridge_from_priv(pcie);
pci_stop_root_bus(host->bus);
pci_remove_root_bus(host->bus);
mtk_pcie_free_resources(pcie);
mtk_pcie_irq_teardown(pcie);
mtk_pcie_put_resources(pcie);
return 0;
}
static int __maybe_unused mtk_pcie_suspend_noirq(struct device *dev) static int __maybe_unused mtk_pcie_suspend_noirq(struct device *dev)
{ {
struct mtk_pcie *pcie = dev_get_drvdata(dev); struct mtk_pcie *pcie = dev_get_drvdata(dev);
@ -1245,6 +1295,7 @@ static const struct of_device_id mtk_pcie_ids[] = {
static struct platform_driver mtk_pcie_driver = { static struct platform_driver mtk_pcie_driver = {
.probe = mtk_pcie_probe, .probe = mtk_pcie_probe,
.remove = mtk_pcie_remove,
.driver = { .driver = {
.name = "mtk-pcie", .name = "mtk-pcie",
.of_match_table = mtk_pcie_ids, .of_match_table = mtk_pcie_ids,
@ -1252,4 +1303,5 @@ static struct platform_driver mtk_pcie_driver = {
.pm = &mtk_pcie_pm_ops, .pm = &mtk_pcie_pm_ops,
}, },
}; };
builtin_platform_driver(mtk_pcie_driver); module_platform_driver(mtk_pcie_driver);
MODULE_LICENSE("GPL v2");