Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / arch / powerpc / cpu / ppc4xx / interrupts.c
1 /*
2  * (C) Copyright 2000-2002
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * (C) Copyright 2002 (440 port)
6  * Scott McNutt, Artesyn Communication Producs, smcnutt@artsyncp.com
7  *
8  * (C) Copyright 2003 (440GX port)
9  * Travis B. Sawyer, Sandburst Corporation, tsawyer@sandburst.com
10  *
11  * (C) Copyright 2008 (PPC440X05 port for Virtex 5 FX)
12  * Ricardo Ribalda-Universidad Autonoma de Madrid-ricardo.ribalda@uam.es
13  * Work supported by Qtechnology (htpp://qtec.com)
14  *
15  * SPDX-License-Identifier:     GPL-2.0+
16  */
17
18 #include <common.h>
19 #include <watchdog.h>
20 #include <command.h>
21 #include <asm/processor.h>
22 #include <asm/interrupt.h>
23 #include <asm/ppc4xx.h>
24 #include <ppc_asm.tmpl>
25 #include <commproc.h>
26
27 DECLARE_GLOBAL_DATA_PTR;
28
29 /*
30  * CPM interrupt vector functions.
31  */
32 struct  irq_action {
33         interrupt_handler_t *handler;
34         void *arg;
35         int count;
36 };
37 static struct irq_action irq_vecs[IRQ_MAX];
38
39 #if defined(CONFIG_440)
40
41 /* SPRN changed in 440 */
42 static __inline__ void set_evpr(unsigned long val)
43 {
44         asm volatile("mtspr 0x03f,%0" : : "r" (val));
45 }
46
47 #else /* !defined(CONFIG_440) */
48
49 static __inline__ void set_pit(unsigned long val)
50 {
51         asm volatile("mtpit %0" : : "r" (val));
52 }
53
54 static __inline__ void set_evpr(unsigned long val)
55 {
56         asm volatile("mtevpr %0" : : "r" (val));
57 }
58 #endif /* defined(CONFIG_440 */
59
60 int interrupt_init_cpu (unsigned *decrementer_count)
61 {
62         int vec;
63         unsigned long val;
64
65         /* decrementer is automatically reloaded */
66         *decrementer_count = 0;
67
68         /*
69          * Mark all irqs as free
70          */
71         for (vec = 0; vec < IRQ_MAX; vec++) {
72                 irq_vecs[vec].handler = NULL;
73                 irq_vecs[vec].arg = NULL;
74                 irq_vecs[vec].count = 0;
75         }
76
77 #ifdef CONFIG_4xx
78         /*
79          * Init PIT
80          */
81 #if defined(CONFIG_440)
82         val = mfspr( SPRN_TCR );
83         val &= (~0x04400000);           /* clear DIS & ARE */
84         mtspr( SPRN_TCR, val );
85         mtspr( SPRN_DEC, 0 );           /* Prevent exception after TSR clear*/
86         mtspr( SPRN_DECAR, 0 );         /* clear reload */
87         mtspr( SPRN_TSR, 0x08000000 );  /* clear DEC status */
88         val = gd->bd->bi_intfreq/1000;  /* 1 msec */
89         mtspr( SPRN_DECAR, val );               /* Set auto-reload value */
90         mtspr( SPRN_DEC, val );         /* Set inital val */
91 #else
92         set_pit(gd->bd->bi_intfreq / 1000);
93 #endif
94 #endif  /* CONFIG_4xx */
95
96 #ifdef CONFIG_ADCIOP
97         /*
98          * Init PIT
99          */
100         set_pit(66000);
101 #endif
102
103         /*
104          * Enable PIT
105          */
106         val = mfspr(SPRN_TCR);
107         val |= 0x04400000;
108         mtspr(SPRN_TCR, val);
109
110         /*
111          * Set EVPR to 0
112          */
113         set_evpr(0x00000000);
114
115         /*
116          * Call uic or xilinx_irq pic_enable
117          */
118         pic_enable();
119
120         return (0);
121 }
122
123 void timer_interrupt_cpu(struct pt_regs *regs)
124 {
125         /* nothing to do here */
126         return;
127 }
128
129 void interrupt_run_handler(int vec)
130 {
131         irq_vecs[vec].count++;
132
133         if (irq_vecs[vec].handler != NULL) {
134                 /* call isr */
135                 (*irq_vecs[vec].handler) (irq_vecs[vec].arg);
136         } else {
137                 pic_irq_disable(vec);
138                 printf("Masking bogus interrupt vector %d\n", vec);
139         }
140
141         pic_irq_ack(vec);
142         return;
143 }
144
145 void irq_install_handler(int vec, interrupt_handler_t * handler, void *arg)
146 {
147         /*
148          * Print warning when replacing with a different irq vector
149          */
150         if ((irq_vecs[vec].handler != NULL) && (irq_vecs[vec].handler != handler)) {
151                 printf("Interrupt vector %d: handler 0x%x replacing 0x%x\n",
152                        vec, (uint) handler, (uint) irq_vecs[vec].handler);
153         }
154         irq_vecs[vec].handler = handler;
155         irq_vecs[vec].arg = arg;
156
157         pic_irq_enable(vec);
158         return;
159 }
160
161 void irq_free_handler(int vec)
162 {
163         debug("Free interrupt for vector %d ==> %p\n",
164               vec, irq_vecs[vec].handler);
165
166         pic_irq_disable(vec);
167
168         irq_vecs[vec].handler = NULL;
169         irq_vecs[vec].arg = NULL;
170         return;
171 }
172
173 #if defined(CONFIG_CMD_IRQ)
174 int do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
175 {
176         int vec;
177
178         printf ("Interrupt-Information:\n");
179         printf ("Nr  Routine   Arg       Count\n");
180
181         for (vec = 0; vec < IRQ_MAX; vec++) {
182                 if (irq_vecs[vec].handler != NULL) {
183                         printf ("%02d  %08lx  %08lx  %d\n",
184                                 vec,
185                                 (ulong)irq_vecs[vec].handler,
186                                 (ulong)irq_vecs[vec].arg,
187                                 irq_vecs[vec].count);
188                 }
189         }
190
191         return 0;
192 }
193 #endif