From: Lars-Peter Clausen <lars@metafoo.de>
Date: Sat, 21 Aug 2010 15:58:44 +0000 (+0000)
Subject: Danube: Fix irq ack
X-Git-Url: http://git.lede-project.org./?a=commitdiff_plain;h=bcdf9742beac64c6cd911e3eb03f11cfb6d15bde;p=openwrt%2Fstaging%2Frmilecki.git

Danube: Fix irq ack

SVN-Revision: 22748
---

diff --git a/target/linux/ifxmips/files-2.6.33/arch/mips/ifxmips/danube/irq.c b/target/linux/ifxmips/files-2.6.33/arch/mips/ifxmips/danube/irq.c
index 18b8d01d422..ce198e321c8 100644
--- a/target/linux/ifxmips/files-2.6.33/arch/mips/ifxmips/danube/irq.c
+++ b/target/linux/ifxmips/files-2.6.33/arch/mips/ifxmips/danube/irq.c
@@ -55,6 +55,26 @@ ifxmips_mask_and_ack_irq(unsigned int irq_nr)
 }
 EXPORT_SYMBOL(ifxmips_mask_and_ack_irq);
 
+static void
+ifxmips_ack_irq(unsigned int irq_nr)
+{
+	int i;
+	u32 *isr = IFXMIPS_ICU_IM0_ISR;
+
+	irq_nr -= INT_NUM_IRQ0;
+	for (i = 0; i <= 4; i++)
+	{
+		if (irq_nr < INT_NUM_IM_OFFSET)
+		{
+			ifxmips_w32((1 << irq_nr), isr);
+			return;
+		}
+		isr += IFXMIPS_ICU_OFFSET;
+		irq_nr -= INT_NUM_IM_OFFSET;
+	}
+}
+
+
 void
 ifxmips_enable_irq(unsigned int irq_nr)
 {
@@ -96,7 +116,7 @@ ifxmips_irq_type = {
 	.enable = ifxmips_enable_irq,
 	.disable = ifxmips_disable_irq,
 	.unmask = ifxmips_enable_irq,
-	.ack = ifxmips_end_irq,
+	.ack = ifxmips_ack_irq,
 	.mask = ifxmips_disable_irq,
 	.mask_ack = ifxmips_mask_and_ack_irq,
 	.end = ifxmips_end_irq,