Add support for MSI.

Signed-off-by: Yao Chen <[email protected]>
---
 drivers/pci/dwc/pcie-kirin.c | 39 +++++++++++++++++++++++++++++++++++++++
 1 file changed, 39 insertions(+)

diff --git a/drivers/pci/dwc/pcie-kirin.c b/drivers/pci/dwc/pcie-kirin.c
index d2970a0..4328efe 100644
--- a/drivers/pci/dwc/pcie-kirin.c
+++ b/drivers/pci/dwc/pcie-kirin.c
@@ -426,9 +426,28 @@ static int kirin_pcie_establish_link(struct pcie_port *pp)
        return 0;
 }
 
+static irqreturn_t kirin_pcie_msi_irq_handler(int irq, void *arg)
+{
+       struct pcie_port *pp = arg;
+
+       return dw_handle_msi_irq(pp);
+}
+
+static void kirin_pcie_msi_init(struct pcie_port *pp)
+{
+       dw_pcie_msi_init(pp);
+}
+
+static void kirin_pcie_enable_interrupts(struct pcie_port *pp)
+{
+       if (IS_ENABLED(CONFIG_PCI_MSI))
+               kirin_pcie_msi_init(pp);
+}
+
 static int kirin_pcie_host_init(struct pcie_port *pp)
 {
        kirin_pcie_establish_link(pp);
+       kirin_pcie_enable_interrupts(pp);
 
        return 0;
 }
@@ -448,6 +467,26 @@ static int kirin_pcie_host_init(struct pcie_port *pp)
 static int __init kirin_add_pcie_port(struct dw_pcie *pci,
                                      struct platform_device *pdev)
 {
+       int ret;
+
+       if (IS_ENABLED(CONFIG_PCI_MSI)) {
+               pci->pp.msi_irq = platform_get_irq(pdev, 0);
+               if (!pci->pp.msi_irq) {
+                       dev_err(&pdev->dev, "failed to get msi irq[%d]\n",
+                               pci->pp.msi_irq);
+                       return -ENODEV;
+               }
+               ret = devm_request_irq(&pdev->dev, pci->pp.msi_irq,
+                                      kirin_pcie_msi_irq_handler,
+                                      IRQF_SHARED | IRQF_NO_THREAD,
+                                      "kirin_pcie_msi", &pci->pp);
+               if (ret) {
+                       dev_err(&pdev->dev, "failed to request msi irq[%d]\n",
+                               pci->pp.msi_irq);
+                       return ret;
+               }
+       }
+
        pci->pp.ops = &kirin_pcie_host_ops;
 
        return dw_pcie_host_init(&pci->pp);
-- 
1.9.1

Reply via email to