1 files changed, 84 insertions, 0 deletions
diff --git a/arch/arm/mach-wmt/irq.c b/arch/arm/mach-wmt/irq.c
new file mode 100755
index 00000000..925b4b0a
--- /dev/null
+++ b/arch/arm/mach-wmt/irq.c
@@ -0,0 +1,84 @@
+/*++
+linux/arch/arm/mach-wmt/irq.c
+
+IRQ settings for WMT
+
+Copyright (c) 2009 WonderMedia Technologies, Inc.
+
+This program is free software: you can redistribute it and/or modify it under the
+terms of the GNU General Public License as published by the Free Software Foundation,
+either version 2 of the License, or (at your option) any later version.
+
+This program is distributed in the hope that it will be useful, but WITHOUT
+ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A
+PARTICULAR PURPOSE.  See the GNU General Public License for more details.
+You should have received a copy of the GNU General Public License along with
+this program.  If not, see <http://www.gnu.org/licenses/>.
+
+WonderMedia Technologies, Inc.
+10F, 529, Chung-Cheng Road, Hsin-Tien, Taipei 231, R.O.C.
+--*/
+
+#include <linux/kernel.h>
+#include <linux/irq.h>
+#include <linux/io.h>
+#include <linux/of.h>
+#include <asm/hardware/gic.h>
+
+#include <mach/wmt_secure.h>
+
+extern int wmt_getsyspara(char *varname, unsigned char *varval, int *varlen);
+/*
+ * Follows are handlers for normal irq_chip
+ */
+static void wmt_mask_irq(struct irq_data *data)
+{
+
+}
+
+static void wmt_unmask_irq(struct irq_data *data)
+{
+
+}
+
+static void wmt_ack_irq(struct irq_data *data)
+{
+
+}
+
+#ifdef CONFIG_OF
+static const struct of_device_id wmt_dt_gic_match[] __initconst = {
+	{ .compatible = "arm,cortex-a9-gic", .data = gic_of_init },
+	{ }
+};
+#endif
+
+void wmt_irq_stub()
+{
+       asm volatile ( "cpsie i" );
+	wmt_smc(WMT_SMC_CMD_IRQ_RET, 0);
+}
+
+void __init wmt_init_irq(void)
+{
+	gic_arch_extn.irq_ack = wmt_ack_irq;
+	gic_arch_extn.irq_mask = wmt_mask_irq;
+	gic_arch_extn.irq_unmask = wmt_unmask_irq;
+
+	if (!of_have_populated_dt())
+		gic_init(0, 29, (void __iomem *)WMT_GIC_DIST_BASE, (void __iomem *)WMT_GIC_CPU_BASE);
+#ifdef CONFIG_OF
+	else
+		of_irq_init(wmt_dt_gic_match);
+#endif
+	unsigned char buf[40];
+	int varlen=40;
+	unsigned int cpu_trustzone_enabled = 0;
+
+	if (wmt_getsyspara("wmt.secure.param",buf,&varlen) == 0)
+		sscanf(buf,"%d",&cpu_trustzone_enabled);
+	if(cpu_trustzone_enabled != 1)
+		cpu_trustzone_enabled = 0;
+	if(cpu_trustzone_enabled != 0)
+		wmt_smc(WMT_SMC_CMD_IRQOK, (unsigned int)wmt_irq_stub);
+}