Commit b728766c authored by Philipp Zabel's avatar Philipp Zabel Committed by Greg Kroah-Hartman

staging: drm/imx: convert IPU irq driver to irq_domain_add_linear

The IPU has a lot of interrupts. Instead of allocating descs for all
of them, register a linear irq domain and create mappings as needed.
This was listed in the TODO as a prerequisite to move the IPU driver
out of staging.
Signed-off-by: default avatarPhilipp Zabel <p.zabel@pengutronix.de>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent e4f2a54e
...@@ -6,7 +6,6 @@ TODO: ...@@ -6,7 +6,6 @@ TODO:
- Factor out more code to common helper functions - Factor out more code to common helper functions
- decide where to put the base driver. It is not specific to a subsystem - decide where to put the base driver. It is not specific to a subsystem
and would be used by DRM/KMS and media/V4L2 and would be used by DRM/KMS and media/V4L2
- convert irq driver to irq_domain_add_linear
Missing features (not necessarily for moving out of staging): Missing features (not necessarily for moving out of staging):
......
...@@ -27,6 +27,7 @@ ...@@ -27,6 +27,7 @@
#include <linux/list.h> #include <linux/list.h>
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/irqchip/chained_irq.h> #include <linux/irqchip/chained_irq.h>
#include <linux/irqdomain.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include "imx-ipu-v3.h" #include "imx-ipu-v3.h"
...@@ -799,16 +800,18 @@ static int ipu_submodules_init(struct ipu_soc *ipu, ...@@ -799,16 +800,18 @@ static int ipu_submodules_init(struct ipu_soc *ipu,
static void ipu_irq_handle(struct ipu_soc *ipu, const int *regs, int num_regs) static void ipu_irq_handle(struct ipu_soc *ipu, const int *regs, int num_regs)
{ {
unsigned long status; unsigned long status;
int i, bit, irq_base; int i, bit, irq;
for (i = 0; i < num_regs; i++) { for (i = 0; i < num_regs; i++) {
status = ipu_cm_read(ipu, IPU_INT_STAT(regs[i])); status = ipu_cm_read(ipu, IPU_INT_STAT(regs[i]));
status &= ipu_cm_read(ipu, IPU_INT_CTRL(regs[i])); status &= ipu_cm_read(ipu, IPU_INT_CTRL(regs[i]));
irq_base = ipu->irq_start + regs[i] * 32; for_each_set_bit(bit, &status, 32) {
for_each_set_bit(bit, &status, 32) irq = irq_linear_revmap(ipu->domain, regs[i] * 32 + bit);
generic_handle_irq(irq_base + bit); if (irq)
generic_handle_irq(irq);
}
} }
} }
...@@ -841,7 +844,7 @@ static void ipu_err_irq_handler(unsigned int irq, struct irq_desc *desc) ...@@ -841,7 +844,7 @@ static void ipu_err_irq_handler(unsigned int irq, struct irq_desc *desc)
static void ipu_ack_irq(struct irq_data *d) static void ipu_ack_irq(struct irq_data *d)
{ {
struct ipu_soc *ipu = irq_data_get_irq_chip_data(d); struct ipu_soc *ipu = irq_data_get_irq_chip_data(d);
unsigned int irq = d->irq - ipu->irq_start; irq_hw_number_t irq = d->hwirq;
ipu_cm_write(ipu, 1 << (irq % 32), IPU_INT_STAT(irq / 32)); ipu_cm_write(ipu, 1 << (irq % 32), IPU_INT_STAT(irq / 32));
} }
...@@ -849,7 +852,7 @@ static void ipu_ack_irq(struct irq_data *d) ...@@ -849,7 +852,7 @@ static void ipu_ack_irq(struct irq_data *d)
static void ipu_unmask_irq(struct irq_data *d) static void ipu_unmask_irq(struct irq_data *d)
{ {
struct ipu_soc *ipu = irq_data_get_irq_chip_data(d); struct ipu_soc *ipu = irq_data_get_irq_chip_data(d);
unsigned int irq = d->irq - ipu->irq_start; irq_hw_number_t irq = d->hwirq;
unsigned long flags; unsigned long flags;
u32 reg; u32 reg;
...@@ -865,7 +868,7 @@ static void ipu_unmask_irq(struct irq_data *d) ...@@ -865,7 +868,7 @@ static void ipu_unmask_irq(struct irq_data *d)
static void ipu_mask_irq(struct irq_data *d) static void ipu_mask_irq(struct irq_data *d)
{ {
struct ipu_soc *ipu = irq_data_get_irq_chip_data(d); struct ipu_soc *ipu = irq_data_get_irq_chip_data(d);
unsigned int irq = d->irq - ipu->irq_start; irq_hw_number_t irq = d->hwirq;
unsigned long flags; unsigned long flags;
u32 reg; u32 reg;
...@@ -888,7 +891,12 @@ static struct irq_chip ipu_irq_chip = { ...@@ -888,7 +891,12 @@ static struct irq_chip ipu_irq_chip = {
int ipu_idmac_channel_irq(struct ipu_soc *ipu, struct ipuv3_channel *channel, int ipu_idmac_channel_irq(struct ipu_soc *ipu, struct ipuv3_channel *channel,
enum ipu_channel_irq irq_type) enum ipu_channel_irq irq_type)
{ {
return ipu->irq_start + irq_type + channel->num; int irq = irq_linear_revmap(ipu->domain, irq_type + channel->num);
if (!irq)
irq = irq_create_mapping(ipu->domain, irq_type + channel->num);
return irq;
} }
EXPORT_SYMBOL_GPL(ipu_idmac_channel_irq); EXPORT_SYMBOL_GPL(ipu_idmac_channel_irq);
...@@ -975,18 +983,30 @@ static int ipu_add_client_devices(struct ipu_soc *ipu) ...@@ -975,18 +983,30 @@ static int ipu_add_client_devices(struct ipu_soc *ipu)
return ret; return ret;
} }
static int ipu_irq_init(struct ipu_soc *ipu) static int ipu_irq_map(struct irq_domain *h, unsigned int irq,
irq_hw_number_t hw)
{ {
int i; struct ipu_soc *ipu = h->host_data;
irq_set_chip_and_handler(irq, &ipu_irq_chip, handle_level_irq);
set_irq_flags(irq, IRQF_VALID);
irq_set_chip_data(irq, ipu);
return 0;
}
ipu->irq_start = irq_alloc_descs(-1, 0, IPU_NUM_IRQS, 0); const struct irq_domain_ops ipu_irq_domain_ops = {
if (ipu->irq_start < 0) .map = ipu_irq_map,
return ipu->irq_start; .xlate = irq_domain_xlate_onecell,
};
for (i = ipu->irq_start; i < ipu->irq_start + IPU_NUM_IRQS; i++) { static int ipu_irq_init(struct ipu_soc *ipu)
irq_set_chip_and_handler(i, &ipu_irq_chip, handle_level_irq); {
set_irq_flags(i, IRQF_VALID); ipu->domain = irq_domain_add_linear(ipu->dev->of_node, IPU_NUM_IRQS,
irq_set_chip_data(i, ipu); &ipu_irq_domain_ops, ipu);
if (!ipu->domain) {
dev_err(ipu->dev, "failed to add irq domain\n");
return -ENODEV;
} }
irq_set_chained_handler(ipu->irq_sync, ipu_irq_handler); irq_set_chained_handler(ipu->irq_sync, ipu_irq_handler);
...@@ -999,20 +1019,20 @@ static int ipu_irq_init(struct ipu_soc *ipu) ...@@ -999,20 +1019,20 @@ static int ipu_irq_init(struct ipu_soc *ipu)
static void ipu_irq_exit(struct ipu_soc *ipu) static void ipu_irq_exit(struct ipu_soc *ipu)
{ {
int i; int i, irq;
irq_set_chained_handler(ipu->irq_err, NULL); irq_set_chained_handler(ipu->irq_err, NULL);
irq_set_handler_data(ipu->irq_err, NULL); irq_set_handler_data(ipu->irq_err, NULL);
irq_set_chained_handler(ipu->irq_sync, NULL); irq_set_chained_handler(ipu->irq_sync, NULL);
irq_set_handler_data(ipu->irq_sync, NULL); irq_set_handler_data(ipu->irq_sync, NULL);
for (i = ipu->irq_start; i < ipu->irq_start + IPU_NUM_IRQS; i++) { for (i = 0; i < IPU_NUM_IRQS; i++) {
set_irq_flags(i, 0); irq = irq_linear_revmap(ipu->domain, i);
irq_set_chip(i, NULL); if (irq)
irq_set_chip_data(i, NULL); irq_dispose_mapping(irq);
} }
irq_free_descs(ipu->irq_start, IPU_NUM_IRQS); irq_domain_remove(ipu->domain);
} }
static int ipu_probe(struct platform_device *pdev) static int ipu_probe(struct platform_device *pdev)
......
...@@ -170,9 +170,9 @@ struct ipu_soc { ...@@ -170,9 +170,9 @@ struct ipu_soc {
struct ipuv3_channel channel[64]; struct ipuv3_channel channel[64];
int irq_start;
int irq_sync; int irq_sync;
int irq_err; int irq_err;
struct irq_domain *domain;
struct ipu_dc_priv *dc_priv; struct ipu_dc_priv *dc_priv;
struct ipu_dp_priv *dp_priv; struct ipu_dp_priv *dp_priv;
......
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