Commit df97e5f3 authored by Arnd Bergmann's avatar Arnd Bergmann

Merge tag 'soc-fsl-fix-v5.14' of...

Merge tag 'soc-fsl-fix-v5.14' of git://git.kernel.org/pub/scm/linux/kernel/git/leo/linux into arm/fixes

NXP/FSL SoC driver fixes for v5.14

QE interrupt controller driver
- Convert it to platform_device driver to make it work with fw_devlink
- Fix static analysis issue

* tag 'soc-fsl-fix-v5.14' of git://git.kernel.org/pub/scm/linux/kernel/git/leo/linux:
  soc: fsl: qe: fix static checker warning
  soc: fsl: qe: convert QE interrupt controller to platform_device

Link: https://lore.kernel.org/r/20210813222305.13663-1-leoyang.li@nxp.comSigned-off-by: default avatarArnd Bergmann <arnd@arndb.de>
parents cbfece75 c1e64c0a
...@@ -23,6 +23,7 @@ ...@@ -23,6 +23,7 @@
#include <linux/signal.h> #include <linux/signal.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/spinlock.h> #include <linux/spinlock.h>
#include <linux/platform_device.h>
#include <asm/irq.h> #include <asm/irq.h>
#include <asm/io.h> #include <asm/io.h>
#include <soc/fsl/qe/qe.h> #include <soc/fsl/qe/qe.h>
...@@ -53,8 +54,8 @@ struct qe_ic { ...@@ -53,8 +54,8 @@ struct qe_ic {
struct irq_chip hc_irq; struct irq_chip hc_irq;
/* VIRQ numbers of QE high/low irqs */ /* VIRQ numbers of QE high/low irqs */
unsigned int virq_high; int virq_high;
unsigned int virq_low; int virq_low;
}; };
/* /*
...@@ -404,42 +405,40 @@ static void qe_ic_cascade_muxed_mpic(struct irq_desc *desc) ...@@ -404,42 +405,40 @@ static void qe_ic_cascade_muxed_mpic(struct irq_desc *desc)
chip->irq_eoi(&desc->irq_data); chip->irq_eoi(&desc->irq_data);
} }
static void __init qe_ic_init(struct device_node *node) static int qe_ic_init(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev;
void (*low_handler)(struct irq_desc *desc); void (*low_handler)(struct irq_desc *desc);
void (*high_handler)(struct irq_desc *desc); void (*high_handler)(struct irq_desc *desc);
struct qe_ic *qe_ic; struct qe_ic *qe_ic;
struct resource res; struct resource *res;
u32 ret; struct device_node *node = pdev->dev.of_node;
ret = of_address_to_resource(node, 0, &res); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (ret) if (res == NULL) {
return; dev_err(dev, "no memory resource defined\n");
return -ENODEV;
}
qe_ic = kzalloc(sizeof(*qe_ic), GFP_KERNEL); qe_ic = devm_kzalloc(dev, sizeof(*qe_ic), GFP_KERNEL);
if (qe_ic == NULL) if (qe_ic == NULL)
return; return -ENOMEM;
qe_ic->irqhost = irq_domain_add_linear(node, NR_QE_IC_INTS, qe_ic->regs = devm_ioremap(dev, res->start, resource_size(res));
&qe_ic_host_ops, qe_ic); if (qe_ic->regs == NULL) {
if (qe_ic->irqhost == NULL) { dev_err(dev, "failed to ioremap() registers\n");
kfree(qe_ic); return -ENODEV;
return;
} }
qe_ic->regs = ioremap(res.start, resource_size(&res));
qe_ic->hc_irq = qe_ic_irq_chip; qe_ic->hc_irq = qe_ic_irq_chip;
qe_ic->virq_high = irq_of_parse_and_map(node, 0); qe_ic->virq_high = platform_get_irq(pdev, 0);
qe_ic->virq_low = irq_of_parse_and_map(node, 1); qe_ic->virq_low = platform_get_irq(pdev, 1);
if (!qe_ic->virq_low) { if (qe_ic->virq_low <= 0)
printk(KERN_ERR "Failed to map QE_IC low IRQ\n"); return -ENODEV;
kfree(qe_ic);
return; if (qe_ic->virq_high > 0 && qe_ic->virq_high != qe_ic->virq_low) {
}
if (qe_ic->virq_high != qe_ic->virq_low) {
low_handler = qe_ic_cascade_low; low_handler = qe_ic_cascade_low;
high_handler = qe_ic_cascade_high; high_handler = qe_ic_cascade_high;
} else { } else {
...@@ -447,29 +446,42 @@ static void __init qe_ic_init(struct device_node *node) ...@@ -447,29 +446,42 @@ static void __init qe_ic_init(struct device_node *node)
high_handler = NULL; high_handler = NULL;
} }
qe_ic->irqhost = irq_domain_add_linear(node, NR_QE_IC_INTS,
&qe_ic_host_ops, qe_ic);
if (qe_ic->irqhost == NULL) {
dev_err(dev, "failed to add irq domain\n");
return -ENODEV;
}
qe_ic_write(qe_ic->regs, QEIC_CICR, 0); qe_ic_write(qe_ic->regs, QEIC_CICR, 0);
irq_set_handler_data(qe_ic->virq_low, qe_ic); irq_set_handler_data(qe_ic->virq_low, qe_ic);
irq_set_chained_handler(qe_ic->virq_low, low_handler); irq_set_chained_handler(qe_ic->virq_low, low_handler);
if (qe_ic->virq_high && qe_ic->virq_high != qe_ic->virq_low) { if (high_handler) {
irq_set_handler_data(qe_ic->virq_high, qe_ic); irq_set_handler_data(qe_ic->virq_high, qe_ic);
irq_set_chained_handler(qe_ic->virq_high, high_handler); irq_set_chained_handler(qe_ic->virq_high, high_handler);
} }
return 0;
} }
static const struct of_device_id qe_ic_ids[] = {
{ .compatible = "fsl,qe-ic"},
{ .type = "qeic"},
{},
};
static int __init qe_ic_of_init(void) static struct platform_driver qe_ic_driver =
{ {
struct device_node *np; .driver = {
.name = "qe-ic",
.of_match_table = qe_ic_ids,
},
.probe = qe_ic_init,
};
np = of_find_compatible_node(NULL, NULL, "fsl,qe-ic"); static int __init qe_ic_of_init(void)
if (!np) { {
np = of_find_node_by_type(NULL, "qeic"); platform_driver_register(&qe_ic_driver);
if (!np)
return -ENODEV;
}
qe_ic_init(np);
of_node_put(np);
return 0; return 0;
} }
subsys_initcall(qe_ic_of_init); subsys_initcall(qe_ic_of_init);
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment