SAFE public projects git trees. - safe/jmp/linux-2.6/blob - arch/mips/ddb5xxx/ddb5477/irq_5477.c

   1 /*
   2  * Copyright 2001 MontaVista Software Inc.
   3  * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
   4  *
   5  *  arch/mips/ddb5xxx/ddb5477/irq_5477.c
   6  *     This file defines the irq handler for Vrc5477.
   7  *
   8  * This program is free software; you can redistribute  it and/or modify it
   9  * under  the terms of  the GNU General  Public License as published by the
  10  * Free Software Foundation;  either version 2 of the  License, or (at your
  11  * option) any later version.
  12  *
  13  */
  14
  15 /*
  16  * Vrc5477 defines 32 IRQs.
  17  *
  18  * This file exports one function:
  19  *      vrc5477_irq_init(u32 irq_base);
  20  */
  21
  22 #include <linux/interrupt.h>
  23 #include <linux/types.h>
  24 #include <linux/ptrace.h>
  25
  26 #include <asm/debug.h>
  27
  28 #include <asm/ddb5xxx/ddb5xxx.h>
  29
  30 /* number of total irqs supported by Vrc5477 */
  31 #define NUM_5477_IRQ            32
  32
  33 static int vrc5477_irq_base = -1;
  34
  35
  36 static void
  37 vrc5477_irq_enable(unsigned int irq)
  38 {
  39         db_assert(vrc5477_irq_base != -1);
  40         db_assert(irq >= vrc5477_irq_base);
  41         db_assert(irq < vrc5477_irq_base+ NUM_5477_IRQ);
  42
  43         ll_vrc5477_irq_enable(irq - vrc5477_irq_base);
  44 }
  45
  46 static void
  47 vrc5477_irq_disable(unsigned int irq)
  48 {
  49         db_assert(vrc5477_irq_base != -1);
  50         db_assert(irq >= vrc5477_irq_base);
  51         db_assert(irq < vrc5477_irq_base + NUM_5477_IRQ);
  52
  53         ll_vrc5477_irq_disable(irq - vrc5477_irq_base);
  54 }
  55
  56 static unsigned int vrc5477_irq_startup(unsigned int irq)
  57 {
  58         vrc5477_irq_enable(irq);
  59         return 0;
  60 }
  61
  62 #define vrc5477_irq_shutdown    vrc5477_irq_disable
  63
  64 static void
  65 vrc5477_irq_ack(unsigned int irq)
  66 {
  67         db_assert(vrc5477_irq_base != -1);
  68         db_assert(irq >= vrc5477_irq_base);
  69         db_assert(irq < vrc5477_irq_base+ NUM_5477_IRQ);
  70
  71         /* clear the interrupt bit */
  72         /* some irqs require the driver to clear the sources */
  73         ddb_out32(DDB_INTCLR32, 1 << (irq - vrc5477_irq_base));
  74
  75         /* disable interrupt - some handler will re-enable the irq
  76          * and if the interrupt is leveled, we will have infinite loop
  77          */
  78         ll_vrc5477_irq_disable(irq - vrc5477_irq_base);
  79 }
  80
  81 static void
  82 vrc5477_irq_end(unsigned int irq)
  83 {
  84         db_assert(vrc5477_irq_base != -1);
  85         db_assert(irq >= vrc5477_irq_base);
  86         db_assert(irq < vrc5477_irq_base + NUM_5477_IRQ);
  87
  88         if(!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
  89                 ll_vrc5477_irq_enable( irq - vrc5477_irq_base);
  90 }
  91
  92 hw_irq_controller vrc5477_irq_controller = {
  93         "vrc5477_irq",
  94         vrc5477_irq_startup,
  95         vrc5477_irq_shutdown,
  96         vrc5477_irq_enable,
  97         vrc5477_irq_disable,
  98         vrc5477_irq_ack,
  99         vrc5477_irq_end,
 100         NULL                    /* no affinity stuff for UP */
 101 };
 102
 103 void __init vrc5477_irq_init(u32 irq_base)
 104 {
 105         u32 i;
 106
 107         for (i= irq_base; i< irq_base+ NUM_5477_IRQ; i++) {
 108                 irq_desc[i].status = IRQ_DISABLED;
 109                 irq_desc[i].action = NULL;
 110                 irq_desc[i].depth = 1;
 111                 irq_desc[i].handler = &vrc5477_irq_controller;
 112         }
 113
 114         vrc5477_irq_base = irq_base;
 115 }
 116
 117 void ll_vrc5477_irq_route(int vrc5477_irq, int ip)
 118 {
 119         u32 reg_value;
 120         u32 reg_bitmask;
 121         u32 reg_index;
 122
 123         db_assert(vrc5477_irq >= 0);
 124         db_assert(vrc5477_irq < NUM_5477_IRQ);
 125         db_assert(ip >= 0);
 126         db_assert((ip < 5) || (ip == 6));
 127
 128         reg_index = DDB_INTCTRL0 + vrc5477_irq/8*4;
 129         reg_value = ddb_in32(reg_index);
 130         reg_bitmask = 7 << (vrc5477_irq % 8 * 4);
 131         reg_value &= ~reg_bitmask;
 132         reg_value |= ip << (vrc5477_irq % 8 * 4);
 133         ddb_out32(reg_index, reg_value);
 134 }
 135
 136 void ll_vrc5477_irq_enable(int vrc5477_irq)
 137 {
 138         u32 reg_value;
 139         u32 reg_bitmask;
 140         u32 reg_index;
 141
 142         db_assert(vrc5477_irq >= 0);
 143         db_assert(vrc5477_irq < NUM_5477_IRQ);
 144
 145         reg_index = DDB_INTCTRL0 + vrc5477_irq/8*4;
 146         reg_value = ddb_in32(reg_index);
 147         reg_bitmask = 8 << (vrc5477_irq % 8 * 4);
 148         db_assert((reg_value & reg_bitmask) == 0);
 149         ddb_out32(reg_index, reg_value | reg_bitmask);
 150 }
 151
 152 void ll_vrc5477_irq_disable(int vrc5477_irq)
 153 {
 154         u32 reg_value;
 155         u32 reg_bitmask;
 156         u32 reg_index;
 157
 158         db_assert(vrc5477_irq >= 0);
 159         db_assert(vrc5477_irq < NUM_5477_IRQ);
 160
 161         reg_index = DDB_INTCTRL0 + vrc5477_irq/8*4;
 162         reg_value = ddb_in32(reg_index);
 163         reg_bitmask = 8 << (vrc5477_irq % 8 * 4);
 164
 165         /* we assert that the interrupt is enabled (perhaps over-zealous) */
 166         db_assert( (reg_value & reg_bitmask) != 0);
 167         ddb_out32(reg_index, reg_value & ~reg_bitmask);
 168 }