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