PageRenderTime 57ms CodeModel.GetById 12ms app.highlight 39ms RepoModel.GetById 1ms app.codeStats 1ms

/arch/h8300/kernel/ints.c

https://bitbucket.org/evzijst/gittest
C | 255 lines | 193 code | 37 blank | 25 comment | 43 complexity | aef4288aaebeae2eefc893ed9c233441 MD5 | raw file
  1/*
  2 * linux/arch/h8300/platform/h8300h/ints.c
  3 *
  4 * Yoshinori Sato <ysato@users.sourceforge.jp>
  5 *
  6 * Based on linux/arch/$(ARCH)/platform/$(PLATFORM)/ints.c
  7 *
  8 * This file is subject to the terms and conditions of the GNU General Public
  9 * License.  See the file COPYING in the main directory of this archive
 10 * for more details.
 11 *
 12 * Copyright 1996 Roman Zippel
 13 * Copyright 1999 D. Jeff Dionne <jeff@rt-control.com>
 14 */
 15
 16#include <linux/module.h>
 17#include <linux/types.h>
 18#include <linux/kernel.h>
 19#include <linux/sched.h>
 20#include <linux/kernel_stat.h>
 21#include <linux/seq_file.h>
 22#include <linux/init.h>
 23#include <linux/random.h>
 24#include <linux/bootmem.h>
 25#include <linux/hardirq.h>
 26
 27#include <asm/system.h>
 28#include <asm/irq.h>
 29#include <asm/traps.h>
 30#include <asm/io.h>
 31#include <asm/setup.h>
 32#include <asm/errno.h>
 33
 34/*
 35 * This structure has only 4 elements for speed reasons
 36 */
 37typedef struct irq_handler {
 38	irqreturn_t (*handler)(int, void *, struct pt_regs *);
 39	int         flags;
 40	int         count;
 41	void	    *dev_id;
 42	const char  *devname;
 43} irq_handler_t;
 44
 45static irq_handler_t *irq_list[NR_IRQS];
 46static int use_kmalloc;
 47
 48extern unsigned long *interrupt_redirect_table;
 49extern const int h8300_saved_vectors[];
 50extern const unsigned long h8300_trap_table[];
 51int h8300_enable_irq_pin(unsigned int irq);
 52void h8300_disable_irq_pin(unsigned int irq);
 53
 54#define CPU_VECTOR ((unsigned long *)0x000000)
 55#define ADDR_MASK (0xffffff)
 56
 57#if defined(CONFIG_RAMKERNEL)
 58static unsigned long __init *get_vector_address(void)
 59{
 60	unsigned long *rom_vector = CPU_VECTOR;
 61	unsigned long base,tmp;
 62	int vec_no;
 63
 64	base = rom_vector[EXT_IRQ0] & ADDR_MASK;
 65	
 66	/* check romvector format */
 67	for (vec_no = EXT_IRQ1; vec_no <= EXT_IRQ0+EXT_IRQS; vec_no++) {
 68		if ((base+(vec_no - EXT_IRQ0)*4) != (rom_vector[vec_no] & ADDR_MASK))
 69			return NULL;
 70	}
 71
 72	/* ramvector base address */
 73	base -= EXT_IRQ0*4;
 74
 75	/* writerble check */
 76	tmp = ~(*(volatile unsigned long *)base);
 77	(*(volatile unsigned long *)base) = tmp;
 78	if ((*(volatile unsigned long *)base) != tmp)
 79		return NULL;
 80	return (unsigned long *)base;
 81}
 82#endif
 83
 84void __init init_IRQ(void)
 85{
 86#if defined(CONFIG_RAMKERNEL)
 87	int i;
 88	unsigned long *ramvec,*ramvec_p;
 89	const unsigned long *trap_entry;
 90	const int *saved_vector;
 91
 92	ramvec = get_vector_address();
 93	if (ramvec == NULL)
 94		panic("interrupt vector serup failed.");
 95	else
 96		printk(KERN_INFO "virtual vector at 0x%08lx\n",(unsigned long)ramvec);
 97
 98	/* create redirect table */
 99	ramvec_p = ramvec;
100	trap_entry = h8300_trap_table;
101	saved_vector = h8300_saved_vectors;
102	for ( i = 0; i < NR_IRQS; i++) {
103		if (i == *saved_vector) {
104			ramvec_p++;
105			saved_vector++;
106		} else {
107			if ( i < NR_TRAPS ) {
108				if (*trap_entry)
109					*ramvec_p = VECTOR(*trap_entry);
110				ramvec_p++;
111				trap_entry++;
112			} else
113				*ramvec_p++ = REDIRECT(interrupt_entry);
114		}
115	}
116	interrupt_redirect_table = ramvec;
117#ifdef DUMP_VECTOR
118	ramvec_p = ramvec;
119	for (i = 0; i < NR_IRQS; i++) {
120		if ((i % 8) == 0)
121			printk(KERN_DEBUG "\n%p: ",ramvec_p);
122		printk(KERN_DEBUG "%p ",*ramvec_p);
123		ramvec_p++;
124	}
125	printk(KERN_DEBUG "\n");
126#endif
127#endif
128}
129
130int request_irq(unsigned int irq, 
131		irqreturn_t (*handler)(int, void *, struct pt_regs *),
132                unsigned long flags, const char *devname, void *dev_id)
133{
134	irq_handler_t *irq_handle;
135	if (irq < 0 || irq >= NR_IRQS) {
136		printk(KERN_ERR "Incorrect IRQ %d from %s\n", irq, devname);
137		return -EINVAL;
138	}
139
140	if (irq_list[irq] || (h8300_enable_irq_pin(irq) == -EBUSY))
141		return -EBUSY;
142
143	if (use_kmalloc)
144		irq_handle = (irq_handler_t *)kmalloc(sizeof(irq_handler_t), GFP_ATOMIC);
145	else {
146		/* use bootmem allocater */
147		irq_handle = (irq_handler_t *)alloc_bootmem(sizeof(irq_handler_t));
148		irq_handle = (irq_handler_t *)((unsigned long)irq_handle | 0x80000000);
149	}
150
151	if (irq_handle == NULL)
152		return -ENOMEM;
153
154	irq_handle->handler = handler;
155	irq_handle->flags   = flags;
156	irq_handle->count   = 0;
157	irq_handle->dev_id  = dev_id;
158	irq_handle->devname = devname;
159	irq_list[irq] = irq_handle;
160
161	if (irq_handle->flags & SA_SAMPLE_RANDOM)
162		rand_initialize_irq(irq);
163
164	enable_irq(irq);
165	return 0;
166}
167
168EXPORT_SYMBOL(request_irq);
169
170void free_irq(unsigned int irq, void *dev_id)
171{
172	if (irq >= NR_IRQS)
173		return;
174
175	if (!irq_list[irq] || irq_list[irq]->dev_id != dev_id)
176		printk(KERN_WARNING "Removing probably wrong IRQ %d from %s\n",
177		       irq, irq_list[irq]->devname);
178	disable_irq(irq);
179	h8300_disable_irq_pin(irq);
180	if (((unsigned long)irq_list[irq] & 0x80000000) == 0) {
181		kfree(irq_list[irq]);
182		irq_list[irq] = NULL;
183	}
184}
185
186EXPORT_SYMBOL(free_irq);
187
188/*
189 * Do we need these probe functions on the m68k?
190 */
191unsigned long probe_irq_on (void)
192{
193	return 0;
194}
195
196EXPORT_SYMBOL(probe_irq_on);
197
198int probe_irq_off (unsigned long irqs)
199{
200	return 0;
201}
202
203EXPORT_SYMBOL(probe_irq_off);
204
205void enable_irq(unsigned int irq)
206{
207	if (irq >= EXT_IRQ0 && irq <= (EXT_IRQ0 + EXT_IRQS))
208		IER_REGS |= 1 << (irq - EXT_IRQ0);
209}
210
211void disable_irq(unsigned int irq)
212{
213	if (irq >= EXT_IRQ0 && irq <= (EXT_IRQ0 + EXT_IRQS))
214		IER_REGS &= ~(1 << (irq - EXT_IRQ0));
215}
216
217asmlinkage void process_int(int irq, struct pt_regs *fp)
218{
219	irq_enter();
220	h8300_clear_isr(irq);
221	if (irq >= NR_TRAPS && irq < NR_IRQS) {
222		if (irq_list[irq]) {
223			irq_list[irq]->handler(irq, irq_list[irq]->dev_id, fp);
224			irq_list[irq]->count++;
225			if (irq_list[irq]->flags & SA_SAMPLE_RANDOM)
226				add_interrupt_randomness(irq);
227		}
228	} else {
229		BUG();
230	}
231	irq_exit();
232}
233
234int show_interrupts(struct seq_file *p, void *v)
235{
236	int i = *(loff_t *) v;
237
238	if ((i < NR_IRQS) && (irq_list[i]!=NULL)) {
239		seq_printf(p, "%3d: %10u ",i,irq_list[i]->count);
240		seq_printf(p, "%s\n", irq_list[i]->devname);
241	}
242
243	return 0;
244}
245
246void init_irq_proc(void)
247{
248}
249
250static int __init enable_kmalloc(void)
251{
252	use_kmalloc = 1;
253	return 0;
254}
255core_initcall(enable_kmalloc);