1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
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);
}
|
