lkml.org 
[lkml]   [2023]   [Dec]   [14]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH v13 17/21] PCI: plda: Add host init/deinit and map bus functions
    Date
    Add PLDA host plda_pcie_host_init()/plda_pcie_host_deinit() and map bus
    function. So vendor can use it to init PLDA PCIe host core.

    Add struct plda_event instance to init PCIe interrupt.

    Signed-off-by: Minda Chen <minda.chen@starfivetech.com>
    Reviewed-by: Mason Huo <mason.huo@starfivetech.com>
    ---
    drivers/pci/controller/plda/pcie-plda-host.c | 134 +++++++++++++++++--
    drivers/pci/controller/plda/pcie-plda.h | 21 +++
    2 files changed, 142 insertions(+), 13 deletions(-)

    diff --git a/drivers/pci/controller/plda/pcie-plda-host.c b/drivers/pci/controller/plda/pcie-plda-host.c
    index 3cba58a37093..53a9bef353a3 100644
    --- a/drivers/pci/controller/plda/pcie-plda-host.c
    +++ b/drivers/pci/controller/plda/pcie-plda-host.c
    @@ -3,6 +3,7 @@
    * PLDA PCIe XpressRich host controller driver
    *
    * Copyright (C) 2023 Microchip Co. Ltd
    + * StarFive Co. Ltd
    *
    * Author: Daire McNamara <daire.mcnamara@microchip.com>
    */
    @@ -18,6 +19,15 @@

    #include "pcie-plda.h"

    +void __iomem *plda_pcie_map_bus(struct pci_bus *bus, unsigned int devfn,
    + int where)
    +{
    + struct plda_pcie_rp *pcie = bus->sysdata;
    +
    + return pcie->config_base + PCIE_ECAM_OFFSET(bus->number, devfn, where);
    +}
    +EXPORT_SYMBOL_GPL(plda_pcie_map_bus);
    +
    static void plda_handle_msi(struct irq_desc *desc)
    {
    struct plda_pcie_rp *port = irq_desc_get_handler_data(desc);
    @@ -375,6 +385,11 @@ static const struct irq_domain_ops plda_event_domain_ops = {
    .map = plda_pcie_event_map,
    };

    +static const struct plda_event plda_default_event = {
    + .intx_event = EVENT_PM_MSI_INT_INTX,
    + .msi_event = EVENT_PM_MSI_INT_MSI
    +};
    +
    static int plda_pcie_init_irq_domains(struct plda_pcie_rp *port)
    {
    struct device *dev = port->dev;
    @@ -421,8 +436,7 @@ int plda_init_interrupts(struct platform_device *pdev,
    const struct plda_event *event)
    {
    struct device *dev = &pdev->dev;
    - int irq;
    - int i, intx_irq, msi_irq, event_irq;
    + int i, event_irq;
    int ret;

    if (!port->event_ops)
    @@ -437,8 +451,8 @@ int plda_init_interrupts(struct platform_device *pdev,
    return ret;
    }

    - irq = platform_get_irq(pdev, 0);
    - if (irq < 0)
    + port->irq = platform_get_irq(pdev, 0);
    + if (port->irq < 0)
    return -ENODEV;

    for (i = 0; i < port->num_events; i++) {
    @@ -461,26 +475,26 @@ int plda_init_interrupts(struct platform_device *pdev,
    }
    }

    - intx_irq = irq_create_mapping(port->event_domain,
    - event->intx_event);
    - if (!intx_irq) {
    + port->intx_irq = irq_create_mapping(port->event_domain,
    + event->intx_event);
    + if (!port->intx_irq) {
    dev_err(dev, "failed to map INTx interrupt\n");
    return -ENXIO;
    }

    /* Plug the INTx chained handler */
    - irq_set_chained_handler_and_data(intx_irq, plda_handle_intx, port);
    + irq_set_chained_handler_and_data(port->intx_irq, plda_handle_intx, port);

    - msi_irq = irq_create_mapping(port->event_domain,
    - event->msi_event);
    - if (!msi_irq)
    + port->msi_irq = irq_create_mapping(port->event_domain,
    + event->msi_event);
    + if (!port->msi_irq)
    return -ENXIO;

    /* Plug the MSI chained handler */
    - irq_set_chained_handler_and_data(msi_irq, plda_handle_msi, port);
    + irq_set_chained_handler_and_data(port->msi_irq, plda_handle_msi, port);

    /* Plug the main event chained handler */
    - irq_set_chained_handler_and_data(irq, plda_handle_event, port);
    + irq_set_chained_handler_and_data(port->irq, plda_handle_event, port);

    return 0;
    }
    @@ -546,3 +560,97 @@ int plda_pcie_setup_iomems(struct pci_host_bridge *bridge,
    return 0;
    }
    EXPORT_SYMBOL_GPL(plda_pcie_setup_iomems);
    +
    +static void plda_pcie_irq_domain_deinit(struct plda_pcie_rp *pcie)
    +{
    + irq_set_chained_handler_and_data(pcie->irq, NULL, NULL);
    + irq_set_chained_handler_and_data(pcie->msi_irq, NULL, NULL);
    + irq_set_chained_handler_and_data(pcie->intx_irq, NULL, NULL);
    +
    + irq_domain_remove(pcie->msi.msi_domain);
    + irq_domain_remove(pcie->msi.dev_domain);
    +
    + irq_domain_remove(pcie->intx_domain);
    + irq_domain_remove(pcie->event_domain);
    +}
    +
    +int plda_pcie_host_init(struct plda_pcie_rp *port, struct pci_ops *ops)
    +{
    + struct device *dev = port->dev;
    + struct pci_host_bridge *bridge;
    + struct platform_device *pdev = to_platform_device(dev);
    + struct resource *cfg_res;
    + int ret;
    +
    + pdev = to_platform_device(dev);
    +
    + port->bridge_addr =
    + devm_platform_ioremap_resource_byname(pdev, "apb");
    +
    + if (IS_ERR(port->bridge_addr))
    + return dev_err_probe(dev, PTR_ERR(port->bridge_addr),
    + "failed to map reg memory\n");
    +
    + cfg_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "cfg");
    + if (!cfg_res)
    + return dev_err_probe(dev, -ENODEV,
    + "failed to get config memory\n");
    +
    + port->config_base = devm_ioremap_resource(dev, cfg_res);
    + if (IS_ERR(port->config_base))
    + return dev_err_probe(dev, PTR_ERR(port->config_base),
    + "failed to map config memory\n");
    +
    + bridge = devm_pci_alloc_host_bridge(dev, 0);
    + if (!bridge)
    + return dev_err_probe(dev, -ENOMEM,
    + "failed to alloc bridge\n");
    +
    + if (port->host_ops && port->host_ops->host_init) {
    + ret = port->host_ops->host_init(port);
    + if (ret)
    + return ret;
    + }
    +
    + port->bridge = bridge;
    + plda_pcie_setup_window(port->bridge_addr, 0, cfg_res->start, 0,
    + resource_size(cfg_res));
    + plda_pcie_setup_iomems(bridge, port);
    + plda_set_default_msi(&port->msi);
    + ret = plda_init_interrupts(pdev, port, &plda_default_event);
    + if (ret)
    + goto err_host;
    +
    + /* Set default bus ops */
    + bridge->ops = ops;
    + bridge->sysdata = port;
    +
    + ret = pci_host_probe(bridge);
    + if (ret < 0) {
    + dev_err_probe(dev, ret, "failed to probe pci host\n");
    + goto err_probe;
    + }
    +
    + return ret;
    +
    +err_probe:
    + plda_pcie_irq_domain_deinit(port);
    +err_host:
    + if (port->host_ops && port->host_ops->host_deinit)
    + port->host_ops->host_deinit(port);
    +
    + return ret;
    +}
    +EXPORT_SYMBOL_GPL(plda_pcie_host_init);
    +
    +void plda_pcie_host_deinit(struct plda_pcie_rp *port)
    +{
    + pci_stop_root_bus(port->bridge->bus);
    + pci_remove_root_bus(port->bridge->bus);
    +
    + plda_pcie_irq_domain_deinit(port);
    +
    + if (port->host_ops && port->host_ops->host_deinit)
    + port->host_ops->host_deinit(port);
    +}
    +EXPORT_SYMBOL_GPL(plda_pcie_host_deinit);
    diff --git a/drivers/pci/controller/plda/pcie-plda.h b/drivers/pci/controller/plda/pcie-plda.h
    index fecef389d6cc..fd2e464552a9 100644
    --- a/drivers/pci/controller/plda/pcie-plda.h
    +++ b/drivers/pci/controller/plda/pcie-plda.h
    @@ -136,6 +136,11 @@ struct plda_event_ops {
    u32 (*get_events)(struct plda_pcie_rp *pcie);
    };

    +struct plda_pcie_host_ops {
    + int (*host_init)(struct plda_pcie_rp *pcie);
    + void (*host_deinit)(struct plda_pcie_rp *pcie);
    +};
    +
    struct plda_msi {
    struct mutex lock; /* Protect used bitmap */
    struct irq_domain *msi_domain;
    @@ -147,13 +152,19 @@ struct plda_msi {

    struct plda_pcie_rp {
    struct device *dev;
    + struct pci_host_bridge *bridge;
    struct irq_domain *intx_domain;
    struct irq_domain *event_domain;
    raw_spinlock_t lock;
    struct plda_msi msi;
    const struct plda_event_ops *event_ops;
    const struct irq_chip *event_irq_chip;
    + const struct plda_pcie_host_ops *host_ops;
    void __iomem *bridge_addr;
    + void __iomem *config_base;
    + int irq;
    + int msi_irq;
    + int intx_irq;
    int num_events;
    };

    @@ -164,6 +175,8 @@ struct plda_event {
    int msi_event;
    };

    +void __iomem *plda_pcie_map_bus(struct pci_bus *bus, unsigned int devfn,
    + int where);
    int plda_init_interrupts(struct platform_device *pdev,
    struct plda_pcie_rp *port,
    const struct plda_event *event);
    @@ -172,4 +185,12 @@ void plda_pcie_setup_window(void __iomem *bridge_base_addr, u32 index,
    size_t size);
    int plda_pcie_setup_iomems(struct pci_host_bridge *bridge,
    struct plda_pcie_rp *port);
    +int plda_pcie_host_init(struct plda_pcie_rp *pcie, struct pci_ops *ops);
    +void plda_pcie_host_deinit(struct plda_pcie_rp *pcie);
    +
    +static inline void plda_set_default_msi(struct plda_msi *msi)
    +{
    + msi->vector_phy = IMSI_ADDR;
    + msi->num_vectors = PLDA_MAX_NUM_MSI_IRQS;
    +}
    #endif
    --
    2.17.1
    \
     
     \ /
      Last update: 2023-12-14 08:31    [W:6.827 / U:0.032 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site