blob: 7f6e1363e7402e18a360ebcc27cc6ee1aee780d9 [file] [log] [blame]
wdenk0db5bca2003-03-31 17:27:09 +00001/*
2 * (C) Copyright 2000-2002 Wolfgang Denk, DENX Software Engineering, wd@denx.de.
3 * (C) Copyright 2003 Martin Winistoerfer, martinwinistoerfer@gmx.ch.
4 *
5 * See file CREDITS for list of people who contributed to this
6 * project.
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
wdenk8bde7f72003-06-27 21:31:46 +000020 * Foundation,
wdenk0db5bca2003-03-31 17:27:09 +000021 */
22
23/*
24 * File: interrupt.c
wdenk8bde7f72003-06-27 21:31:46 +000025 *
wdenk0db5bca2003-03-31 17:27:09 +000026 * Discription: Contains interrupt routines needed by U-Boot
27 *
28 */
29
30#include <common.h>
wdenkb6e4c402004-01-02 16:05:07 +000031#include <command.h>
wdenk0db5bca2003-03-31 17:27:09 +000032#include <mpc5xx.h>
33#include <asm/processor.h>
34
wdenkb6e4c402004-01-02 16:05:07 +000035#if defined(CONFIG_PATI)
36/* PATI uses IRQs for PCI doorbell */
37#undef NR_IRQS
38#define NR_IRQS 16
39#endif
40
wdenk0db5bca2003-03-31 17:27:09 +000041struct interrupt_action {
42 interrupt_handler_t *handler;
43 void *arg;
wdenkb6e4c402004-01-02 16:05:07 +000044 int count;
wdenk0db5bca2003-03-31 17:27:09 +000045};
46
47static struct interrupt_action irq_vecs[NR_IRQS];
48
49/*
wdenk8bde7f72003-06-27 21:31:46 +000050 * Initialise interrupts
wdenk0db5bca2003-03-31 17:27:09 +000051 */
52
wdenka8c7c702003-12-06 19:49:23 +000053int interrupt_init_cpu (ulong *decrementer_count)
wdenk0db5bca2003-03-31 17:27:09 +000054{
55 volatile immap_t *immr = (immap_t *) CFG_IMMR;
wdenkb6e4c402004-01-02 16:05:07 +000056 int vec;
wdenk0db5bca2003-03-31 17:27:09 +000057
58 /* Decrementer used here for status led */
wdenka8c7c702003-12-06 19:49:23 +000059 *decrementer_count = get_tbclk () / CFG_HZ;
wdenk0db5bca2003-03-31 17:27:09 +000060
61 /* Disable all interrupts */
62 immr->im_siu_conf.sc_simask = 0;
wdenkb6e4c402004-01-02 16:05:07 +000063 for (vec=0; vec<NR_IRQS; vec++) {
64 irq_vecs[vec].handler = NULL;
65 irq_vecs[vec].arg = NULL;
66 irq_vecs[vec].count = 0;
67 }
wdenk0db5bca2003-03-31 17:27:09 +000068
wdenk0db5bca2003-03-31 17:27:09 +000069 return (0);
70}
71
72/*
73 * Handle external interrupts
74 */
75void external_interrupt (struct pt_regs *regs)
76{
77 volatile immap_t *immr = (immap_t *) CFG_IMMR;
78 int irq;
79 ulong simask, newmask;
80 ulong vec, v_bit;
81
82 /*
83 * read the SIVEC register and shift the bits down
84 * to get the irq number
85 */
86 vec = immr->im_siu_conf.sc_sivec;
87 irq = vec >> 26;
88 v_bit = 0x80000000UL >> irq;
89
90 /*
91 * Read Interrupt Mask Register and Mask Interrupts
92 */
93 simask = immr->im_siu_conf.sc_simask;
94 newmask = simask & (~(0xFFFF0000 >> irq));
95 immr->im_siu_conf.sc_simask = newmask;
96
97 if (!(irq & 0x1)) { /* External Interrupt ? */
98 ulong siel;
99
100 /*
101 * Read Interrupt Edge/Level Register
102 */
103 siel = immr->im_siu_conf.sc_siel;
104
105 if (siel & v_bit) { /* edge triggered interrupt ? */
106 /*
107 * Rewrite SIPEND Register to clear interrupt
108 */
109 immr->im_siu_conf.sc_sipend = v_bit;
110 }
111 }
112
113 if (irq_vecs[irq].handler != NULL) {
114 irq_vecs[irq].handler (irq_vecs[irq].arg);
115 } else {
116 printf ("\nBogus External Interrupt IRQ %d Vector %ld\n",
117 irq, vec);
118 /* turn off the bogus interrupt to avoid it from now */
119 simask &= ~v_bit;
120 }
121 /*
122 * Re-Enable old Interrupt Mask
123 */
124 immr->im_siu_conf.sc_simask = simask;
125}
126
127/*
128 * Install and free an interrupt handler
129 */
130void irq_install_handler (int vec, interrupt_handler_t * handler,
131 void *arg)
132{
133 volatile immap_t *immr = (immap_t *) CFG_IMMR;
134 /* SIU interrupt */
135 if (irq_vecs[vec].handler != NULL) {
136 printf ("SIU interrupt %d 0x%x\n",
137 vec,
138 (uint) handler);
139 }
140 irq_vecs[vec].handler = handler;
141 irq_vecs[vec].arg = arg;
142 immr->im_siu_conf.sc_simask |= 1 << (31 - vec);
143#if 0
144 printf ("Install SIU interrupt for vector %d ==> %p\n",
145 vec, handler);
146#endif
147}
148
149void irq_free_handler (int vec)
150{
151 volatile immap_t *immr = (immap_t *) CFG_IMMR;
152 /* SIU interrupt */
153#if 0
154 printf ("Free CPM interrupt for vector %d\n",
155 vec);
156#endif
157 immr->im_siu_conf.sc_simask &= ~(1 << (31 - vec));
158 irq_vecs[vec].handler = NULL;
159 irq_vecs[vec].arg = NULL;
160}
161
wdenk0db5bca2003-03-31 17:27:09 +0000162/*
wdenk8bde7f72003-06-27 21:31:46 +0000163 * Timer interrupt - gets called when bit 0 of DEC changes from
wdenk0db5bca2003-03-31 17:27:09 +0000164 * 0. Decrementer is enabled with bit TBE in TBSCR.
165 */
wdenka8c7c702003-12-06 19:49:23 +0000166void timer_interrupt_cpu (struct pt_regs *regs)
wdenk0db5bca2003-03-31 17:27:09 +0000167{
168 volatile immap_t *immr = (immap_t *) CFG_IMMR;
169
wdenk0db5bca2003-03-31 17:27:09 +0000170#if 0
171 printf ("*** Timer Interrupt *** ");
172#endif
173 /* Reset Timer Status Bit and Timers Interrupt Status */
174 immr->im_clkrstk.cark_plprcrk = KAPWR_KEY;
175 __asm__ ("nop");
176 immr->im_clkrst.car_plprcr |= PLPRCR_TEXPS | PLPRCR_TMIST;
wdenk8bde7f72003-06-27 21:31:46 +0000177
wdenka8c7c702003-12-06 19:49:23 +0000178 return;
wdenk0db5bca2003-03-31 17:27:09 +0000179}
wdenkb6e4c402004-01-02 16:05:07 +0000180
181#if (CONFIG_COMMANDS & CFG_CMD_IRQ)
182/*******************************************************************************
183 *
184 * irqinfo - print information about IRQs
185 *
186 */
187int do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
188{
189 int vec;
190
191 printf ("\nInterrupt-Information:\n");
192 printf ("Nr Routine Arg Count\n");
193
194 for (vec=0; vec<NR_IRQS; vec++) {
195 if (irq_vecs[vec].handler != NULL) {
196 printf ("%02d %08lx %08lx %d\n",
197 vec,
198 (ulong)irq_vecs[vec].handler,
199 (ulong)irq_vecs[vec].arg,
200 irq_vecs[vec].count);
201 }
202 }
203 return 0;
204}
205
206
207#endif /* CONFIG_COMMANDS & CFG_CMD_IRQ */