lkml.org 
[lkml]   [2022]   [Jul]   [18]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
/
From
Date
SubjectRe: [PATCH V16 09/14] irqchip/loongson-pch-msi: Add ACPI init support
Hi, Jianmin,

On Mon, Jul 18, 2022 at 10:21 PM Jianmin Lv <lvjianmin@loongson.cn> wrote:
>
> From: Huacai Chen <chenhuacai@loongson.cn>
>
> PCH-PIC/PCH-MSI stands for "Interrupt Controller" that described in
> Section 5 of "Loongson 7A1000 Bridge User Manual". For more information
> please refer Documentation/loongarch/irq-chip-model.rst.
>
> Co-developed-by: Jianmin Lv <lvjianmin@loongson.cn>
> Signed-off-by: Jianmin Lv <lvjianmin@loongson.cn>
> Signed-off-by: Huacai Chen <chenhuacai@loongson.cn>
> ---
> arch/loongarch/include/asm/irq.h | 12 ++-
> arch/loongarch/kernel/irq.c | 1 -
> drivers/irqchip/irq-loongson-pch-msi.c | 131 ++++++++++++++++++++++-----------
> 3 files changed, 99 insertions(+), 45 deletions(-)
>
> diff --git a/arch/loongarch/include/asm/irq.h b/arch/loongarch/include/asm/irq.h
> index 74fef60..3e61824 100644
> --- a/arch/loongarch/include/asm/irq.h
> +++ b/arch/loongarch/include/asm/irq.h
> @@ -106,11 +106,20 @@ struct irq_domain *htvec_acpi_init(struct irq_domain *parent,
> struct acpi_madt_ht_pic *acpi_htvec);
> int pch_lpc_acpi_init(struct irq_domain *parent,
> struct acpi_madt_lpc_pic *acpi_pchlpc);
> -struct irq_domain *pch_msi_acpi_init(struct irq_domain *parent,
> +#if IS_ENABLED(CONFIG_LOONGSON_PCH_MSI)
> +int pch_msi_acpi_init(struct irq_domain *parent,
> struct acpi_madt_msi_pic *acpi_pchmsi);
> +#else
> +static inline int pch_msi_acpi_init(struct irq_domain *parent,
> + struct acpi_madt_msi_pic *acpi_pchmsi)
> +{
> + return 0;
> +}
> +#endif
> int pch_pic_acpi_init(struct irq_domain *parent,
> struct acpi_madt_bio_pic *acpi_pchpic);
> int find_pch_pic(u32 gsi);
> +struct fwnode_handle *get_pch_msi_handle(int pci_segment);
>
> extern struct acpi_madt_lio_pic *acpi_liointc;
> extern struct acpi_madt_eio_pic *acpi_eiointc[MAX_IO_PICS];
> @@ -123,7 +132,6 @@ int pch_pic_acpi_init(struct irq_domain *parent,
> extern struct irq_domain *cpu_domain;
> extern struct irq_domain *liointc_domain;
> extern struct fwnode_handle *pch_lpc_handle;
> -extern struct irq_domain *pch_msi_domain[MAX_IO_PICS];
> extern struct fwnode_handle *pch_pic_handle[MAX_IO_PICS];
>
> extern irqreturn_t loongson3_ipi_interrupt(int irq, void *dev);
> diff --git a/arch/loongarch/kernel/irq.c b/arch/loongarch/kernel/irq.c
> index 866b2ee..ce21281 100644
> --- a/arch/loongarch/kernel/irq.c
> +++ b/arch/loongarch/kernel/irq.c
> @@ -27,7 +27,6 @@
>
> struct irq_domain *cpu_domain;
> struct irq_domain *liointc_domain;
> -struct irq_domain *pch_msi_domain[MAX_IO_PICS];
>
> /*
> * 'what should we do if we get a hw irq event on an illegal vector'.
> diff --git a/drivers/irqchip/irq-loongson-pch-msi.c b/drivers/irqchip/irq-loongson-pch-msi.c
> index e3801c4..b3f1f8e 100644
> --- a/drivers/irqchip/irq-loongson-pch-msi.c
> +++ b/drivers/irqchip/irq-loongson-pch-msi.c
> @@ -15,6 +15,8 @@
> #include <linux/pci.h>
> #include <linux/slab.h>
>
> +static int nr_pics;
> +
> struct pch_msi_data {
> struct mutex msi_map_lock;
> phys_addr_t doorbell;
> @@ -23,6 +25,8 @@ struct pch_msi_data {
> unsigned long *msi_map;
> };
>
> +static struct fwnode_handle *pch_msi_handle[MAX_IO_PICS];
> +
> static void pch_msi_mask_msi_irq(struct irq_data *d)
> {
> pci_msi_mask_irq(d);
> @@ -154,12 +158,12 @@ static void pch_msi_middle_domain_free(struct irq_domain *domain,
> };
>
> static int pch_msi_init_domains(struct pch_msi_data *priv,
> - struct device_node *node,
> - struct irq_domain *parent)
> + struct irq_domain *parent,
> + struct fwnode_handle *domain_handle)
> {
> struct irq_domain *middle_domain, *msi_domain;
>
> - middle_domain = irq_domain_create_linear(of_node_to_fwnode(node),
> + middle_domain = irq_domain_create_linear(domain_handle,
> priv->num_irqs,
> &pch_msi_middle_domain_ops,
> priv);
> @@ -171,7 +175,7 @@ static int pch_msi_init_domains(struct pch_msi_data *priv,
> middle_domain->parent = parent;
> irq_domain_update_bus_token(middle_domain, DOMAIN_BUS_NEXUS);
>
> - msi_domain = pci_msi_create_irq_domain(of_node_to_fwnode(node),
> + msi_domain = pci_msi_create_irq_domain(domain_handle,
> &pch_msi_domain_info,
> middle_domain);
> if (!msi_domain) {
> @@ -183,19 +187,11 @@ static int pch_msi_init_domains(struct pch_msi_data *priv,
> return 0;
> }
>
> -static int pch_msi_init(struct device_node *node,
> - struct device_node *parent)
> +static int pch_msi_init(phys_addr_t msg_address, int irq_base, int irq_count,
> + struct irq_domain *parent_domain, struct fwnode_handle *domain_handle)
> {
> - struct pch_msi_data *priv;
> - struct irq_domain *parent_domain;
> - struct resource res;
> int ret;
> -
> - parent_domain = irq_find_host(parent);
> - if (!parent_domain) {
> - pr_err("Failed to find the parent domain\n");
> - return -ENXIO;
> - }
> + struct pch_msi_data *priv;
>
> priv = kzalloc(sizeof(*priv), GFP_KERNEL);
> if (!priv)
> @@ -203,48 +199,99 @@ static int pch_msi_init(struct device_node *node,
>
> mutex_init(&priv->msi_map_lock);
>
> - ret = of_address_to_resource(node, 0, &res);
> - if (ret) {
> - pr_err("Failed to allocate resource\n");
> - goto err_priv;
> - }
> -
> - priv->doorbell = res.start;
> -
> - if (of_property_read_u32(node, "loongson,msi-base-vec",
> - &priv->irq_first)) {
> - pr_err("Unable to parse MSI vec base\n");
> - ret = -EINVAL;
> - goto err_priv;
> - }
> -
> - if (of_property_read_u32(node, "loongson,msi-num-vecs",
> - &priv->num_irqs)) {
> - pr_err("Unable to parse MSI vec number\n");
> - ret = -EINVAL;
> - goto err_priv;
> - }
> + priv->doorbell = msg_address;
> + priv->irq_first = irq_base;
> + priv->num_irqs = irq_count;
>
> priv->msi_map = bitmap_zalloc(priv->num_irqs, GFP_KERNEL);
> - if (!priv->msi_map) {
> - ret = -ENOMEM;
> + if (!priv->msi_map)
> goto err_priv;
> - }
>
> pr_debug("Registering %d MSIs, starting at %d\n",
> priv->num_irqs, priv->irq_first);
>
> - ret = pch_msi_init_domains(priv, node, parent_domain);
> + ret = pch_msi_init_domains(priv, parent_domain, domain_handle);
> if (ret)
> goto err_map;
>
> + pch_msi_handle[nr_pics++] = domain_handle;
> return 0;
>
> err_map:
> bitmap_free(priv->msi_map);
> err_priv:
> kfree(priv);
> - return ret;
> +
> + return -EINVAL;
> +}
> +
> +#ifdef CONFIG_OF
> +static int pch_msi_of_init(struct device_node *node, struct device_node *parent)
> +{
> + int err;
> + int irq_base, irq_count;
> + struct resource res;
> + struct irq_domain *parent_domain;
> +
> + parent_domain = irq_find_host(parent);
> + if (!parent_domain) {
> + pr_err("Failed to find the parent domain\n");
> + return -ENXIO;
> + }
> +
> + if (of_address_to_resource(node, 0, &res)) {
> + pr_err("Failed to allocate resource\n");
> + return -EINVAL;
> + }
> +
> + if (of_property_read_u32(node, "loongson,msi-base-vec", &irq_base)) {
> + pr_err("Unable to parse MSI vec base\n");
> + return -EINVAL;
> + }
> +
> + if (of_property_read_u32(node, "loongson,msi-num-vecs", &irq_count)) {
> + pr_err("Unable to parse MSI vec number\n");
> + return -EINVAL;
> + }
> +
> + err = pch_msi_init(res.start, irq_base, irq_count, parent_domain, of_node_to_fwnode(node));
> + if (err < 0)
> + return err;
> +
> + return 0;
> +}
> +
> +IRQCHIP_DECLARE(pch_msi, "loongson,pch-msi-1.0", pch_msi_of_init);
> +#endif
> +
> +#ifdef CONFIG_ACPI
> +struct fwnode_handle *get_pch_msi_handle(int pci_segment)
> +{
> + int i;
> +
> + for (i = 0; i < MAX_IO_PICS; i++) {
> + if (msi_group[i].pci_segment == pci_segment)
> + return pch_msi_handle[i];
> + }
> + return NULL;
> }
Not sure, but it seems this function should not be ACPI-specific.

Huacai
>
> -IRQCHIP_DECLARE(pch_msi, "loongson,pch-msi-1.0", pch_msi_init);
> +int __init pch_msi_acpi_init(struct irq_domain *parent,
> + struct acpi_madt_msi_pic *acpi_pchmsi)
> +{
> + int ret;
> + struct fwnode_handle *domain_handle;
> +
> + if (!acpi_pchmsi)
> + return -EINVAL;
> +
> + domain_handle = irq_domain_alloc_fwnode((phys_addr_t *)acpi_pchmsi);
> +
> + ret = pch_msi_init(acpi_pchmsi->msg_address, acpi_pchmsi->start,
> + acpi_pchmsi->count, parent, domain_handle);
> + if (ret < 0)
> + irq_domain_free_fwnode(domain_handle);
> +
> + return ret;
> +}
> +#endif
> --
> 1.8.3.1
>
>

\
 
 \ /
  Last update: 2022-07-19 04:41    [W:0.166 / U:0.048 seconds]
©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site