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