|
@@ -43,6 +43,7 @@
|
|
|
|
|
|
struct s3c_irq_data {
|
|
|
unsigned int type;
|
|
|
+ unsigned long offset;
|
|
|
unsigned long parent_irq;
|
|
|
|
|
|
/* data gets filled during init */
|
|
@@ -79,15 +80,15 @@ static struct s3c_irq_intc *s3c_intc[3];
|
|
|
|
|
|
static void s3c_irq_mask(struct irq_data *data)
|
|
|
{
|
|
|
- struct s3c_irq_intc *intc = data->domain->host_data;
|
|
|
+ struct s3c_irq_data *irq_data = irq_data_get_irq_chip_data(data);
|
|
|
+ struct s3c_irq_intc *intc = irq_data->intc;
|
|
|
struct s3c_irq_intc *parent_intc = intc->parent;
|
|
|
- struct s3c_irq_data *irq_data = &intc->irqs[data->hwirq];
|
|
|
struct s3c_irq_data *parent_data;
|
|
|
unsigned long mask;
|
|
|
unsigned int irqno;
|
|
|
|
|
|
mask = __raw_readl(intc->reg_mask);
|
|
|
- mask |= (1UL << data->hwirq);
|
|
|
+ mask |= (1UL << irq_data->offset);
|
|
|
__raw_writel(mask, intc->reg_mask);
|
|
|
|
|
|
if (parent_intc) {
|
|
@@ -104,14 +105,14 @@ static void s3c_irq_mask(struct irq_data *data)
|
|
|
|
|
|
static void s3c_irq_unmask(struct irq_data *data)
|
|
|
{
|
|
|
- struct s3c_irq_intc *intc = data->domain->host_data;
|
|
|
+ struct s3c_irq_data *irq_data = irq_data_get_irq_chip_data(data);
|
|
|
+ struct s3c_irq_intc *intc = irq_data->intc;
|
|
|
struct s3c_irq_intc *parent_intc = intc->parent;
|
|
|
- struct s3c_irq_data *irq_data = &intc->irqs[data->hwirq];
|
|
|
unsigned long mask;
|
|
|
unsigned int irqno;
|
|
|
|
|
|
mask = __raw_readl(intc->reg_mask);
|
|
|
- mask &= ~(1UL << data->hwirq);
|
|
|
+ mask &= ~(1UL << irq_data->offset);
|
|
|
__raw_writel(mask, intc->reg_mask);
|
|
|
|
|
|
if (parent_intc) {
|
|
@@ -123,8 +124,9 @@ static void s3c_irq_unmask(struct irq_data *data)
|
|
|
|
|
|
static inline void s3c_irq_ack(struct irq_data *data)
|
|
|
{
|
|
|
- struct s3c_irq_intc *intc = data->domain->host_data;
|
|
|
- unsigned long bitval = 1UL << data->hwirq;
|
|
|
+ struct s3c_irq_data *irq_data = irq_data_get_irq_chip_data(data);
|
|
|
+ struct s3c_irq_intc *intc = irq_data->intc;
|
|
|
+ unsigned long bitval = 1UL << irq_data->offset;
|
|
|
|
|
|
__raw_writel(bitval, intc->reg_pending);
|
|
|
if (intc->reg_intpnd)
|
|
@@ -291,8 +293,7 @@ static struct irq_chip s3c_irq_eint0t4 = {
|
|
|
static void s3c_irq_demux(unsigned int irq, struct irq_desc *desc)
|
|
|
{
|
|
|
struct irq_chip *chip = irq_desc_get_chip(desc);
|
|
|
- struct s3c_irq_intc *intc = desc->irq_data.domain->host_data;
|
|
|
- struct s3c_irq_data *irq_data = &intc->irqs[desc->irq_data.hwirq];
|
|
|
+ struct s3c_irq_data *irq_data = irq_desc_get_chip_data(desc);
|
|
|
struct s3c_irq_intc *sub_intc = irq_data->sub_intc;
|
|
|
unsigned long src;
|
|
|
unsigned long msk;
|
|
@@ -406,6 +407,7 @@ static int s3c24xx_irq_map(struct irq_domain *h, unsigned int virq,
|
|
|
|
|
|
/* attach controller pointer to irq_data */
|
|
|
irq_data->intc = intc;
|
|
|
+ irq_data->offset = hw;
|
|
|
|
|
|
parent_intc = intc->parent;
|
|
|
|
|
@@ -444,6 +446,9 @@ static int s3c24xx_irq_map(struct irq_domain *h, unsigned int virq,
|
|
|
pr_err("irq-s3c24xx: unsupported irqtype %d\n", irq_data->type);
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
+
|
|
|
+ irq_set_chip_data(virq, irq_data);
|
|
|
+
|
|
|
set_irq_flags(virq, IRQF_VALID);
|
|
|
|
|
|
if (parent_intc && irq_data->type != S3C_IRQTYPE_NONE) {
|