arch/m68knommu/platform/5307/ints.c

   1 /*
   2  * linux/arch/m68knommu/kernel/ints.c -- General interrupt handling code
   3  *
   4  * Copyright (C) 1999-2002  Greg Ungerer (gerg@snapgear.com)
   5  * Copyright (C) 1998  D. Jeff Dionne <jeff@lineo.ca>,
   6  *                     Kenneth Albanowski <kjahds@kjahds.com>,
   7  * Copyright (C) 2000  Lineo Inc. (www.lineo.com)
   8  *
   9  * Based on:
  10  *
  11  * linux/arch/m68k/kernel/ints.c -- Linux/m68k general interrupt handling code
  12  *
  13  * This file is subject to the terms and conditions of the GNU General Public
  14  * License.  See the file COPYING in the main directory of this archive
  15  * for more details.
  16  */
  17
  18 #include <linux/module.h>
  19 #include <linux/types.h>
  20 #include <linux/init.h>
  21 #include <linux/sched.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/kernel_stat.h>
  24 #include <linux/errno.h>
  25 #include <linux/seq_file.h>
  26
  27 #include <asm/system.h>
  28 #include <asm/irq.h>
  29 #include <asm/irqnode.h>
  30 #include <asm/traps.h>
  31 #include <asm/page.h>
  32 #include <asm/machdep.h>
  33
  34 /*
  35  *      This table stores the address info for each vector handler.
  36  */
  37 struct irq_entry irq_list[SYS_IRQS];
  38
  39 #define NUM_IRQ_NODES 16
  40 static irq_node_t nodes[NUM_IRQ_NODES];
  41
  42 /* The number of spurious interrupts */
  43 volatile unsigned int num_spurious;
  44
  45 unsigned int local_bh_count[NR_CPUS];
  46 unsigned int local_irq_count[NR_CPUS];
  47
  48 static irqreturn_t default_irq_handler(int irq, void *ptr)
  49 {
  50 #if 1
  51         printk(KERN_INFO "%s(%d): default irq handler vec=%d [0x%x]\n",
  52                 __FILE__, __LINE__, irq, irq);
  53 #endif
  54         return(IRQ_HANDLED);
  55 }
  56
  57 /*
  58  * void init_IRQ(void)
  59  *
  60  * Parameters:  None
  61  *
  62  * Returns:     Nothing
  63  *
  64  * This function should be called during kernel startup to initialize
  65  * the IRQ handling routines.
  66  */
  67
  68 void __init init_IRQ(void)
  69 {
  70         int i;
  71
  72         for (i = 0; i < SYS_IRQS; i++) {
  73                 if (mach_default_handler)
  74                         irq_list[i].handler = mach_default_handler;
  75                 else
  76                         irq_list[i].handler = default_irq_handler;
  77                 irq_list[i].flags   = IRQ_FLG_STD;
  78                 irq_list[i].dev_id  = NULL;
  79                 irq_list[i].devname = NULL;
  80         }
  81
  82         for (i = 0; i < NUM_IRQ_NODES; i++)
  83                 nodes[i].handler = NULL;
  84
  85         if (mach_init_IRQ)
  86                 mach_init_IRQ();
  87 }
  88
  89 irq_node_t *new_irq_node(void)
  90 {
  91         irq_node_t *node;
  92         short i;
  93
  94         for (node = nodes, i = NUM_IRQ_NODES-1; i >= 0; node++, i--)
  95                 if (!node->handler)
  96                         return node;
  97
  98         printk(KERN_INFO "new_irq_node: out of nodes\n");
  99         return NULL;
 100 }
 101
 102 int request_irq(
 103         unsigned int irq,
 104         irq_handler_t handler,
 105         unsigned long flags,
 106         const char *devname,
 107         void *dev_id)
 108 {
 109         if (irq < 0 || irq >= NR_IRQS) {
 110                 printk(KERN_WARNING "%s: Incorrect IRQ %d from %s\n", __FUNCTION__,
 111                         irq, devname);
 112                 return -ENXIO;
 113         }
 114
 115         if (!(irq_list[irq].flags & IRQ_FLG_STD)) {
 116                 if (irq_list[irq].flags & IRQ_FLG_LOCK) {
 117                         printk(KERN_WARNING "%s: IRQ %d from %s is not replaceable\n",
 118                                __FUNCTION__, irq, irq_list[irq].devname);
 119                         return -EBUSY;
 120                 }
 121                 if (flags & IRQ_FLG_REPLACE) {
 122                         printk(KERN_WARNING "%s: %s can't replace IRQ %d from %s\n",
 123                                __FUNCTION__, devname, irq, irq_list[irq].devname);
 124                         return -EBUSY;
 125                 }
 126         }
 127
 128         if (flags & IRQ_FLG_FAST) {
 129                 extern asmlinkage void fasthandler(void);
 130                 extern void set_evector(int vecnum, void (*handler)(void));
 131                 set_evector(irq, fasthandler);
 132         }
 133
 134         irq_list[irq].handler = handler;
 135         irq_list[irq].flags   = flags;
 136         irq_list[irq].dev_id  = dev_id;
 137         irq_list[irq].devname = devname;
 138         return 0;
 139 }
 140
 141 EXPORT_SYMBOL(request_irq);
 142
 143 void free_irq(unsigned int irq, void *dev_id)
 144 {
 145         if (irq >= NR_IRQS) {
 146                 printk(KERN_WARNING "%s: Incorrect IRQ %d\n", __FUNCTION__, irq);
 147                 return;
 148         }
 149
 150         if (irq_list[irq].dev_id != dev_id)
 151                 printk(KERN_WARNING "%s: Removing probably wrong IRQ %d from %s\n",
 152                        __FUNCTION__, irq, irq_list[irq].devname);
 153
 154         if (irq_list[irq].flags & IRQ_FLG_FAST) {
 155                 extern asmlinkage void inthandler(void);
 156                 extern void set_evector(int vecnum, void (*handler)(void));
 157                 set_evector(irq, inthandler);
 158         }
 159
 160         if (mach_default_handler)
 161                 irq_list[irq].handler = mach_default_handler;
 162         else
 163                 irq_list[irq].handler = default_irq_handler;
 164         irq_list[irq].flags   = IRQ_FLG_STD;
 165         irq_list[irq].dev_id  = NULL;
 166         irq_list[irq].devname = NULL;
 167 }
 168
 169 EXPORT_SYMBOL(free_irq);
 170
 171
 172 int sys_request_irq(unsigned int irq, irq_handler_t handler,
 173                     unsigned long flags, const char *devname, void *dev_id)
 174 {
 175         if (irq > IRQ7) {
 176                 printk(KERN_WARNING "%s: Incorrect IRQ %d from %s\n",
 177                        __FUNCTION__, irq, devname);
 178                 return -ENXIO;
 179         }
 180
 181 #if 0
 182         if (!(irq_list[irq].flags & IRQ_FLG_STD)) {
 183                 if (irq_list[irq].flags & IRQ_FLG_LOCK) {
 184                         printk(KERN_WARNING "%s: IRQ %d from %s is not replaceable\n",
 185                                __FUNCTION__, irq, irq_list[irq].devname);
 186                         return -EBUSY;
 187                 }
 188                 if (!(flags & IRQ_FLG_REPLACE)) {
 189                         printk(KERN_WARNING "%s: %s can't replace IRQ %d from %s\n",
 190                                __FUNCTION__, devname, irq, irq_list[irq].devname);
 191                         return -EBUSY;
 192                 }
 193         }
 194 #endif
 195
 196         irq_list[irq].handler = handler;
 197         irq_list[irq].flags   = flags;
 198         irq_list[irq].dev_id  = dev_id;
 199         irq_list[irq].devname = devname;
 200         return 0;
 201 }
 202
 203 void sys_free_irq(unsigned int irq, void *dev_id)
 204 {
 205         if (irq > IRQ7) {
 206                 printk(KERN_WARNING "%s: Incorrect IRQ %d\n", __FUNCTION__, irq);
 207                 return;
 208         }
 209
 210         if (irq_list[irq].dev_id != dev_id)
 211                 printk(KERN_WARNING "%s: Removing probably wrong IRQ %d from %s\n",
 212                        __FUNCTION__, irq, irq_list[irq].devname);
 213
 214         irq_list[irq].handler = mach_default_handler;
 215         irq_list[irq].flags   = 0;
 216         irq_list[irq].dev_id  = NULL;
 217         irq_list[irq].devname = NULL;
 218 }
 219
 220 /*
 221  * Do we need these probe functions on the m68k?
 222  *
 223  *  ... may be useful with ISA devices
 224  */
 225 unsigned long probe_irq_on (void)
 226 {
 227         return 0;
 228 }
 229
 230 EXPORT_SYMBOL(probe_irq_on);
 231
 232 int probe_irq_off (unsigned long irqs)
 233 {
 234         return 0;
 235 }
 236
 237 EXPORT_SYMBOL(probe_irq_off);
 238
 239 asmlinkage void process_int(unsigned long vec, struct pt_regs *fp)
 240 {
 241         if (vec >= VEC_INT1 && vec <= VEC_INT7) {
 242                 vec -= VEC_SPUR;
 243                 kstat_cpu(0).irqs[vec]++;
 244                 irq_list[vec].handler(vec, irq_list[vec].dev_id);
 245         } else {
 246                 if (mach_process_int)
 247                         mach_process_int(vec, fp);
 248                 else
 249                         panic("Can't process interrupt vector %ld\n", vec);
 250                 return;
 251         }
 252 }
 253
 254
 255 int show_interrupts(struct seq_file *p, void *v)
 256 {
 257         int i = *(loff_t *) v;
 258
 259         if (i < NR_IRQS) {
 260                 if (! (irq_list[i].flags & IRQ_FLG_STD)) {
 261                         seq_printf(p, "%3d: %10u ", i,
 262                                 (i ? kstat_cpu(0).irqs[i] : num_spurious));
 263                         if (irq_list[i].flags & IRQ_FLG_LOCK)
 264                                 seq_printf(p, "L ");
 265                         else
 266                                 seq_printf(p, "  ");
 267                         seq_printf(p, "%s\n", irq_list[i].devname);
 268                 }
 269         }
 270
 271         if (i == NR_IRQS && mach_get_irq_list)
 272                 mach_get_irq_list(p, v);
 273         return 0;
 274 }
 275
 276 void init_irq_proc(void)
 277 {
 278         /* Insert /proc/irq driver here */
 279 }
 280