arch/m68k/q40/q40ints.c

   1 /*
   2  * arch/m68k/q40/q40ints.c
   3  *
   4  * Copyright (C) 1999,2001 Richard Zidlicky
   5  *
   6  * This file is subject to the terms and conditions of the GNU General Public
   7  * License.  See the file COPYING in the main directory of this archive
   8  * for more details.
   9  *
  10  * .. used to be loosely based on bvme6000ints.c
  11  *
  12  */
  13
  14 #include <linux/config.h>
  15 #include <linux/types.h>
  16 #include <linux/kernel.h>
  17 #include <linux/errno.h>
  18 #include <linux/string.h>
  19 #include <linux/sched.h>
  20 #include <linux/seq_file.h>
  21 #include <linux/interrupt.h>
  22
  23 #include <asm/rtc.h>
  24 #include <asm/ptrace.h>
  25 #include <asm/system.h>
  26 #include <asm/irq.h>
  27 #include <asm/hardirq.h>
  28 #include <asm/traps.h>
  29
  30 #include <asm/q40_master.h>
  31 #include <asm/q40ints.h>
  32
  33 /*
  34  * Q40 IRQs are defined as follows:
  35  *            3,4,5,6,7,10,11,14,15 : ISA dev IRQs
  36  *            16-31: reserved
  37  *            32   : keyboard int
  38  *            33   : frame int (50/200 Hz periodic timer)
  39  *            34   : sample int (10/20 KHz periodic timer)
  40  *
  41 */
  42
  43 extern int ints_inited;
  44
  45
  46 irqreturn_t q40_irq2_handler (int, void *, struct pt_regs *fp);
  47
  48
  49 static irqreturn_t q40_defhand (int irq, void *dev_id, struct pt_regs *fp);
  50 static irqreturn_t default_handler(int lev, void *dev_id, struct pt_regs *regs);
  51
  52
  53 #define DEVNAME_SIZE 24
  54
  55 static struct q40_irq_node {
  56         irqreturn_t     (*handler)(int, void *, struct pt_regs *);
  57         unsigned long   flags;
  58         void            *dev_id;
  59   /*        struct q40_irq_node *next;*/
  60         char            devname[DEVNAME_SIZE];
  61         unsigned        count;
  62         unsigned short  state;
  63 } irq_tab[Q40_IRQ_MAX+1];
  64
  65 short unsigned q40_ablecount[Q40_IRQ_MAX+1];
  66
  67 /*
  68  * void q40_init_IRQ (void)
  69  *
  70  * Parameters:  None
  71  *
  72  * Returns:     Nothing
  73  *
  74  * This function is called during kernel startup to initialize
  75  * the q40 IRQ handling routines.
  76  */
  77
  78 static int disabled=0;
  79
  80 void q40_init_IRQ (void)
  81 {
  82         int i;
  83
  84         disabled=0;
  85         for (i = 0; i <= Q40_IRQ_MAX; i++) {
  86                 irq_tab[i].handler = q40_defhand;
  87                 irq_tab[i].flags = 0;
  88                 irq_tab[i].dev_id = NULL;
  89                 /*              irq_tab[i].next = NULL;*/
  90                 irq_tab[i].devname[0] = 0;
  91                 irq_tab[i].count = 0;
  92                 irq_tab[i].state =0;
  93                 q40_ablecount[i]=0;   /* all enabled */
  94         }
  95
  96         /* setup handler for ISA ints */
  97         cpu_request_irq(IRQ2, q40_irq2_handler, 0, "q40 ISA and master chip",
  98                         NULL);
  99
 100         /* now enable some ints.. */
 101         master_outb(1,EXT_ENABLE_REG);  /* ISA IRQ 5-15 */
 102
 103         /* make sure keyboard IRQ is disabled */
 104         master_outb(0,KEY_IRQ_ENABLE_REG);
 105 }
 106
 107 int q40_request_irq(unsigned int irq,
 108                 irqreturn_t (*handler)(int, void *, struct pt_regs *),
 109                 unsigned long flags, const char *devname, void *dev_id)
 110 {
 111   /*printk("q40_request_irq %d, %s\n",irq,devname);*/
 112
 113         if (irq > Q40_IRQ_MAX || (irq>15 && irq<32)) {
 114                 printk("%s: Incorrect IRQ %d from %s\n", __FUNCTION__, irq, devname);
 115                 return -ENXIO;
 116         }
 117
 118         /* test for ISA ints not implemented by HW */
 119         switch (irq)
 120           {
 121           case 1: case 2: case 8: case 9:
 122           case 12: case 13:
 123             printk("%s: ISA IRQ %d from %s not implemented by HW\n", __FUNCTION__, irq, devname);
 124             return -ENXIO;
 125           case 11:
 126             printk("warning IRQ 10 and 11 not distinguishable\n");
 127             irq=10;
 128           default:
 129             ;
 130           }
 131
 132         if (irq<Q40_IRQ_SAMPLE)
 133           {
 134             if (irq_tab[irq].dev_id != NULL)
 135                   {
 136                     printk("%s: IRQ %d from %s is not replaceable\n",
 137                            __FUNCTION__, irq, irq_tab[irq].devname);
 138                     return -EBUSY;
 139                   }
 140             /*printk("IRQ %d set to handler %p\n",irq,handler);*/
 141             if (dev_id==NULL)
 142                   {
 143                 printk("WARNING: dev_id == NULL in request_irq\n");
 144                 dev_id=(void*)1;
 145               }
 146             irq_tab[irq].handler = handler;
 147             irq_tab[irq].flags   = flags;
 148             irq_tab[irq].dev_id  = dev_id;
 149             strlcpy(irq_tab[irq].devname,devname,sizeof(irq_tab[irq].devname));
 150             irq_tab[irq].state = 0;
 151             return 0;
 152           }
 153         else {
 154           /* Q40_IRQ_SAMPLE :somewhat special actions required here ..*/
 155           cpu_request_irq(4, handler, flags, devname, dev_id);
 156           cpu_request_irq(6, handler, flags, devname, dev_id);
 157           return 0;
 158         }
 159 }
 160
 161 void q40_free_irq(unsigned int irq, void *dev_id)
 162 {
 163         if (irq > Q40_IRQ_MAX || (irq>15 && irq<32)) {
 164                 printk("%s: Incorrect IRQ %d, dev_id %x \n", __FUNCTION__, irq, (unsigned)dev_id);
 165                 return;
 166         }
 167
 168         /* test for ISA ints not implemented by HW */
 169         switch (irq)
 170           {
 171           case 1: case 2: case 8: case 9:
 172           case 12: case 13:
 173             printk("%s: ISA IRQ %d from %x invalid\n", __FUNCTION__, irq, (unsigned)dev_id);
 174             return;
 175           case 11: irq=10;
 176           default:
 177             ;
 178           }
 179
 180         if (irq<Q40_IRQ_SAMPLE)
 181           {
 182             if (irq_tab[irq].dev_id != dev_id)
 183               printk("%s: Removing probably wrong IRQ %d from %s\n",
 184                      __FUNCTION__, irq, irq_tab[irq].devname);
 185
 186             irq_tab[irq].handler = q40_defhand;
 187             irq_tab[irq].flags   = 0;
 188             irq_tab[irq].dev_id  = NULL;
 189             /* irq_tab[irq].devname = NULL; */
 190             /* do not reset state !! */
 191           }
 192         else
 193           { /* == Q40_IRQ_SAMPLE */
 194             cpu_free_irq(4, dev_id);
 195             cpu_free_irq(6, dev_id);
 196           }
 197 }
 198
 199
 200 irqreturn_t q40_process_int (int level, struct pt_regs *fp)
 201 {
 202   printk("unexpected interrupt vec=%x, pc=%lx, d0=%lx, d0_orig=%lx, d1=%lx, d2=%lx\n",
 203           level, fp->pc, fp->d0, fp->orig_d0, fp->d1, fp->d2);
 204   printk("\tIIRQ_REG = %x, EIRQ_REG = %x\n",master_inb(IIRQ_REG),master_inb(EIRQ_REG));
 205   return IRQ_HANDLED;
 206 }
 207
 208 /*
 209  * this stuff doesn't really belong here..
 210 */
 211
 212 int ql_ticks;              /* 200Hz ticks since last jiffie */
 213 static int sound_ticks;
 214
 215 #define SVOL 45
 216
 217 void q40_mksound(unsigned int hz, unsigned int ticks)
 218 {
 219   /* for now ignore hz, except that hz==0 switches off sound */
 220   /* simply alternate the ampl (128-SVOL)-(128+SVOL)-..-.. at 200Hz */
 221   if (hz==0)
 222     {
 223       if (sound_ticks)
 224         sound_ticks=1;
 225
 226       *DAC_LEFT=128;
 227       *DAC_RIGHT=128;
 228
 229       return;
 230     }
 231   /* sound itself is done in q40_timer_int */
 232   if (sound_ticks == 0) sound_ticks=1000; /* pretty long beep */
 233   sound_ticks=ticks<<1;
 234 }
 235
 236 static irqreturn_t (*q40_timer_routine)(int, void *, struct pt_regs *);
 237
 238 static irqreturn_t q40_timer_int (int irq, void * dev, struct pt_regs * regs)
 239 {
 240     ql_ticks = ql_ticks ? 0 : 1;
 241     if (sound_ticks)
 242       {
 243         unsigned char sval=(sound_ticks & 1) ? 128-SVOL : 128+SVOL;
 244         sound_ticks--;
 245         *DAC_LEFT=sval;
 246         *DAC_RIGHT=sval;
 247       }
 248
 249     if (!ql_ticks)
 250         q40_timer_routine(irq, dev, regs);
 251     return IRQ_HANDLED;
 252 }
 253
 254 void q40_sched_init (irqreturn_t (*timer_routine)(int, void *, struct pt_regs *))
 255 {
 256     int timer_irq;
 257
 258     q40_timer_routine = timer_routine;
 259     timer_irq=Q40_IRQ_FRAME;
 260
 261     if (request_irq(timer_irq, q40_timer_int, 0,
 262                                 "timer", q40_timer_int))
 263         panic ("Couldn't register timer int");
 264
 265     master_outb(-1,FRAME_CLEAR_REG);
 266     master_outb( 1,FRAME_RATE_REG);
 267 }
 268
 269
 270 /*
 271  * tables to translate bits into IRQ numbers
 272  * it is a good idea to order the entries by priority
 273  *
 274 */
 275
 276 struct IRQ_TABLE{ unsigned mask; int irq ;};
 277 #if 0
 278 static struct IRQ_TABLE iirqs[]={
 279   {Q40_IRQ_FRAME_MASK,Q40_IRQ_FRAME},
 280   {Q40_IRQ_KEYB_MASK,Q40_IRQ_KEYBOARD},
 281   {0,0}};
 282 #endif
 283 static struct IRQ_TABLE eirqs[] = {
 284   { .mask = Q40_IRQ3_MASK,      .irq = 3 },     /* ser 1 */
 285   { .mask = Q40_IRQ4_MASK,      .irq = 4 },     /* ser 2 */
 286   { .mask = Q40_IRQ14_MASK,     .irq = 14 },    /* IDE 1 */
 287   { .mask = Q40_IRQ15_MASK,     .irq = 15 },    /* IDE 2 */
 288   { .mask = Q40_IRQ6_MASK,      .irq = 6 },     /* floppy, handled elsewhere */
 289   { .mask = Q40_IRQ7_MASK,      .irq = 7 },     /* par */
 290   { .mask = Q40_IRQ5_MASK,      .irq = 5 },
 291   { .mask = Q40_IRQ10_MASK,     .irq = 10 },
 292   {0,0}
 293 };
 294
 295 /* complain only this many times about spurious ints : */
 296 static int ccleirq=60;    /* ISA dev IRQ's*/
 297 /*static int cclirq=60;*/     /* internal */
 298
 299 /* FIXME: add shared ints,mask,unmask,probing.... */
 300
 301 #define IRQ_INPROGRESS 1
 302 /*static unsigned short saved_mask;*/
 303 //static int do_tint=0;
 304
 305 #define DEBUG_Q40INT
 306 /*#define IP_USE_DISABLE *//* would be nice, but crashes ???? */
 307
 308 static int mext_disabled=0;  /* ext irq disabled by master chip? */
 309 static int aliased_irq=0;  /* how many times inside handler ?*/
 310
 311
 312 /* got level 2 interrupt, dispatch to ISA or keyboard/timer IRQs */
 313 irqreturn_t q40_irq2_handler (int vec, void *devname, struct pt_regs *fp)
 314 {
 315   unsigned mir, mer;
 316   int irq,i;
 317
 318 //repeat:
 319   mir=master_inb(IIRQ_REG);
 320   if (mir&Q40_IRQ_FRAME_MASK) {
 321           irq_tab[Q40_IRQ_FRAME].count++;
 322           irq_tab[Q40_IRQ_FRAME].handler(Q40_IRQ_FRAME,irq_tab[Q40_IRQ_FRAME].dev_id,fp);
 323           master_outb(-1,FRAME_CLEAR_REG);
 324   }
 325   if ((mir&Q40_IRQ_SER_MASK) || (mir&Q40_IRQ_EXT_MASK)) {
 326           mer=master_inb(EIRQ_REG);
 327           for (i=0; eirqs[i].mask; i++) {
 328                   if (mer&(eirqs[i].mask)) {
 329                           irq=eirqs[i].irq;
 330 /*
 331  * There is a little mess wrt which IRQ really caused this irq request. The
 332  * main problem is that IIRQ_REG and EIRQ_REG reflect the state when they
 333  * are read - which is long after the request came in. In theory IRQs should
 334  * not just go away but they occassionally do
 335  */
 336                           if (irq>4 && irq<=15 && mext_disabled) {
 337                                   /*aliased_irq++;*/
 338                                   goto iirq;
 339                           }
 340                           if (irq_tab[irq].handler == q40_defhand ) {
 341                                   printk("handler for IRQ %d not defined\n",irq);
 342                                   continue; /* ignore uninited INTs :-( */
 343                           }
 344                           if ( irq_tab[irq].state & IRQ_INPROGRESS ) {
 345                                   /* some handlers do local_irq_enable() for irq latency reasons, */
 346                                   /* however reentering an active irq handler is not permitted */
 347 #ifdef IP_USE_DISABLE
 348                                   /* in theory this is the better way to do it because it still */
 349                                   /* lets through eg the serial irqs, unfortunately it crashes */
 350                                   disable_irq(irq);
 351                                   disabled=1;
 352 #else
 353                                   /*printk("IRQ_INPROGRESS detected for irq %d, disabling - %s disabled\n",irq,disabled ? "already" : "not yet"); */
 354                                   fp->sr = (((fp->sr) & (~0x700))+0x200);
 355                                   disabled=1;
 356 #endif
 357                                   goto iirq;
 358                           }
 359                           irq_tab[irq].count++;
 360                           irq_tab[irq].state |= IRQ_INPROGRESS;
 361                           irq_tab[irq].handler(irq,irq_tab[irq].dev_id,fp);
 362                           irq_tab[irq].state &= ~IRQ_INPROGRESS;
 363
 364                           /* naively enable everything, if that fails than    */
 365                           /* this function will be reentered immediately thus */
 366                           /* getting another chance to disable the IRQ        */
 367
 368                           if ( disabled ) {
 369 #ifdef IP_USE_DISABLE
 370                                   if (irq>4){
 371                                           disabled=0;
 372                                           enable_irq(irq);}
 373 #else
 374                                   disabled=0;
 375                                   /*printk("reenabling irq %d\n",irq); */
 376 #endif
 377                           }
 378 // used to do 'goto repeat;' here, this delayed bh processing too long
 379                           return IRQ_HANDLED;
 380                   }
 381           }
 382           if (mer && ccleirq>0 && !aliased_irq)
 383                   printk("ISA interrupt from unknown source? EIRQ_REG = %x\n",mer),ccleirq--;
 384   }
 385  iirq:
 386   mir=master_inb(IIRQ_REG);
 387   /* should test whether keyboard irq is really enabled, doing it in defhand */
 388   if (mir&Q40_IRQ_KEYB_MASK) {
 389           irq_tab[Q40_IRQ_KEYBOARD].count++;
 390           irq_tab[Q40_IRQ_KEYBOARD].handler(Q40_IRQ_KEYBOARD,irq_tab[Q40_IRQ_KEYBOARD].dev_id,fp);
 391   }
 392   return IRQ_HANDLED;
 393 }
 394
 395 int show_q40_interrupts (struct seq_file *p, void *v)
 396 {
 397         int i;
 398
 399         for (i = 0; i <= Q40_IRQ_MAX; i++) {
 400                 if (irq_tab[i].count)
 401                       seq_printf(p, "%sIRQ %02d: %8d  %s%s\n",
 402                               (i<=15) ? "ISA-" : "    " ,
 403                             i, irq_tab[i].count,
 404                             irq_tab[i].devname[0] ? irq_tab[i].devname : "?",
 405                             irq_tab[i].handler == q40_defhand ?
 406                                         " (now unassigned)" : "");
 407         }
 408         return 0;
 409 }
 410
 411
 412 static irqreturn_t q40_defhand (int irq, void *dev_id, struct pt_regs *fp)
 413 {
 414         if (irq!=Q40_IRQ_KEYBOARD)
 415              printk ("Unknown q40 interrupt %d\n", irq);
 416         else master_outb(-1,KEYBOARD_UNLOCK_REG);
 417         return IRQ_NONE;
 418 }
 419 static irqreturn_t default_handler(int lev, void *dev_id, struct pt_regs *regs)
 420 {
 421         printk ("Uninitialised interrupt level %d\n", lev);
 422         return IRQ_NONE;
 423 }
 424
 425 irqreturn_t (*q40_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
 426          [0] = default_handler,
 427          [1] = default_handler,
 428          [2] = default_handler,
 429          [3] = default_handler,
 430          [4] = default_handler,
 431          [5] = default_handler,
 432          [6] = default_handler,
 433          [7] = default_handler
 434 };
 435
 436
 437 void q40_enable_irq (unsigned int irq)
 438 {
 439   if ( irq>=5 && irq<=15 )
 440   {
 441     mext_disabled--;
 442     if (mext_disabled>0)
 443           printk("q40_enable_irq : nested disable/enable\n");
 444     if (mext_disabled==0)
 445     master_outb(1,EXT_ENABLE_REG);
 446     }
 447 }
 448
 449
 450 void q40_disable_irq (unsigned int irq)
 451 {
 452   /* disable ISA iqs : only do something if the driver has been
 453    * verified to be Q40 "compatible" - right now IDE, NE2K
 454    * Any driver should not attempt to sleep across disable_irq !!
 455    */
 456
 457   if ( irq>=5 && irq<=15 ) {
 458     master_outb(0,EXT_ENABLE_REG);
 459     mext_disabled++;
 460     if (mext_disabled>1) printk("disable_irq nesting count %d\n",mext_disabled);
 461   }
 462 }
 463
 464 unsigned long q40_probe_irq_on (void)
 465 {
 466   printk("irq probing not working - reconfigure the driver to avoid this\n");
 467   return -1;
 468 }
 469 int q40_probe_irq_off (unsigned long irqs)
 470 {
 471   return -1;
 472 }
 473 /*
 474  * Local variables:
 475  * compile-command: "m68k-linux-gcc -D__KERNEL__ -I/home/rz/lx/linux-2.2.6/include -Wall -Wstrict-prototypes -O2 -fomit-frame-pointer -pipe -fno-strength-reduce -ffixed-a2 -m68040   -c -o q40ints.o q40ints.c"
 476  * End:
 477  */