arch/mips/tx4927/common/tx4927_irq.c

   1 /*
   2  * Common tx4927 irq handler
   3  *
   4  * Author: MontaVista Software, Inc.
   5  *         source@mvista.com
   6  *
   7  *  under the terms of the GNU General Public License as published by the
   8  *  Free Software Foundation; either version 2 of the License, or (at your
   9  *  option) any later version.
  10  *
  11  *  THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  12  *  WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  13  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  14  *  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  15  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  16  *  BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  17  *  OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  18  *  ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  19  *  TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
  20  *  USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  21  *
  22  *  You should have received a copy of the GNU General Public License along
  23  *  with this program; if not, write to the Free Software Foundation, Inc.,
  24  *  675 Mass Ave, Cambridge, MA 02139, USA.
  25  */
  26 #include <linux/errno.h>
  27 #include <linux/init.h>
  28 #include <linux/kernel_stat.h>
  29 #include <linux/module.h>
  30 #include <linux/signal.h>
  31 #include <linux/sched.h>
  32 #include <linux/types.h>
  33 #include <linux/interrupt.h>
  34 #include <linux/ioport.h>
  35 #include <linux/timex.h>
  36 #include <linux/slab.h>
  37 #include <linux/random.h>
  38 #include <linux/irq.h>
  39 #include <linux/bitops.h>
  40 #include <asm/bootinfo.h>
  41 #include <asm/io.h>
  42 #include <asm/irq.h>
  43 #include <asm/mipsregs.h>
  44 #include <asm/system.h>
  45 #include <asm/tx4927/tx4927.h>
  46
  47 /*
  48  * DEBUG
  49  */
  50
  51 #undef TX4927_IRQ_DEBUG
  52
  53 #ifdef TX4927_IRQ_DEBUG
  54 #define TX4927_IRQ_NONE        0x00000000
  55
  56 #define TX4927_IRQ_INFO        ( 1 <<  0 )
  57 #define TX4927_IRQ_WARN        ( 1 <<  1 )
  58 #define TX4927_IRQ_EROR        ( 1 <<  2 )
  59
  60 #define TX4927_IRQ_INIT        ( 1 <<  5 )
  61 #define TX4927_IRQ_NEST1       ( 1 <<  6 )
  62 #define TX4927_IRQ_NEST2       ( 1 <<  7 )
  63 #define TX4927_IRQ_NEST3       ( 1 <<  8 )
  64 #define TX4927_IRQ_NEST4       ( 1 <<  9 )
  65
  66 #define TX4927_IRQ_CP0_INIT     ( 1 << 10 )
  67 #define TX4927_IRQ_CP0_ENABLE   ( 1 << 13 )
  68 #define TX4927_IRQ_CP0_DISABLE  ( 1 << 14 )
  69 #define TX4927_IRQ_CP0_ENDIRQ   ( 1 << 16 )
  70
  71 #define TX4927_IRQ_PIC_INIT     ( 1 << 20 )
  72 #define TX4927_IRQ_PIC_ENABLE   ( 1 << 23 )
  73 #define TX4927_IRQ_PIC_DISABLE  ( 1 << 24 )
  74 #define TX4927_IRQ_PIC_ENDIRQ   ( 1 << 26 )
  75
  76 #define TX4927_IRQ_ALL         0xffffffff
  77 #endif
  78
  79 #ifdef TX4927_IRQ_DEBUG
  80 static const u32 tx4927_irq_debug_flag = (TX4927_IRQ_NONE
  81                                           | TX4927_IRQ_INFO
  82                                           | TX4927_IRQ_WARN | TX4927_IRQ_EROR
  83 //                                       | TX4927_IRQ_CP0_INIT
  84 //                                       | TX4927_IRQ_CP0_ENABLE
  85 //                                       | TX4927_IRQ_CP0_DISABLE
  86 //                                       | TX4927_IRQ_CP0_ENDIRQ
  87 //                                       | TX4927_IRQ_PIC_INIT
  88 //                                       | TX4927_IRQ_PIC_ENABLE
  89 //                                       | TX4927_IRQ_PIC_DISABLE
  90 //                                       | TX4927_IRQ_PIC_ENDIRQ
  91 //                                       | TX4927_IRQ_INIT
  92 //                                       | TX4927_IRQ_NEST1
  93 //                                       | TX4927_IRQ_NEST2
  94 //                                       | TX4927_IRQ_NEST3
  95 //                                       | TX4927_IRQ_NEST4
  96     );
  97 #endif
  98
  99 #ifdef TX4927_IRQ_DEBUG
 100 #define TX4927_IRQ_DPRINTK(flag,str...) \
 101         if ( (tx4927_irq_debug_flag) & (flag) ) \
 102         { \
 103            char tmp[100]; \
 104            sprintf( tmp, str ); \
 105            printk( "%s(%s:%u)::%s", __FUNCTION__, __FILE__, __LINE__, tmp ); \
 106         }
 107 #else
 108 #define TX4927_IRQ_DPRINTK(flag,str...)
 109 #endif
 110
 111 /*
 112  * Forwad definitions for all pic's
 113  */
 114
 115 static void tx4927_irq_cp0_enable(unsigned int irq);
 116 static void tx4927_irq_cp0_disable(unsigned int irq);
 117 static void tx4927_irq_cp0_end(unsigned int irq);
 118
 119 static void tx4927_irq_pic_enable(unsigned int irq);
 120 static void tx4927_irq_pic_disable(unsigned int irq);
 121 static void tx4927_irq_pic_end(unsigned int irq);
 122
 123 /*
 124  * Kernel structs for all pic's
 125  */
 126
 127 #define TX4927_CP0_NAME "TX4927-CP0"
 128 static struct irq_chip tx4927_irq_cp0_type = {
 129         .typename       = TX4927_CP0_NAME,
 130         .ack            = tx4927_irq_cp0_disable,
 131         .mask           = tx4927_irq_cp0_disable,
 132         .mask_ack       = tx4927_irq_cp0_disable,
 133         .unmask         = tx4927_irq_cp0_enable,
 134         .end            = tx4927_irq_cp0_end,
 135 };
 136
 137 #define TX4927_PIC_NAME "TX4927-PIC"
 138 static struct irq_chip tx4927_irq_pic_type = {
 139         .typename       = TX4927_PIC_NAME,
 140         .ack            = tx4927_irq_pic_disable,
 141         .mask           = tx4927_irq_pic_disable,
 142         .mask_ack       = tx4927_irq_pic_disable,
 143         .unmask         = tx4927_irq_pic_enable,
 144         .end            = tx4927_irq_pic_end,
 145 };
 146
 147 #define TX4927_PIC_ACTION(s) { no_action, 0, CPU_MASK_NONE, s, NULL, NULL }
 148 static struct irqaction tx4927_irq_pic_action =
 149 TX4927_PIC_ACTION(TX4927_PIC_NAME);
 150
 151 #define CCP0_STATUS 12
 152 #define CCP0_CAUSE 13
 153
 154 /*
 155  * Functions for cp0
 156  */
 157
 158 #define tx4927_irq_cp0_mask(irq) ( 1 << ( irq-TX4927_IRQ_CP0_BEG+8 ) )
 159
 160 static void
 161 tx4927_irq_cp0_modify(unsigned cp0_reg, unsigned clr_bits, unsigned set_bits)
 162 {
 163         unsigned long val = 0;
 164
 165         switch (cp0_reg) {
 166         case CCP0_STATUS:
 167                 val = read_c0_status();
 168                 break;
 169
 170         case CCP0_CAUSE:
 171                 val = read_c0_cause();
 172                 break;
 173
 174         }
 175
 176         val &= (~clr_bits);
 177         val |= (set_bits);
 178
 179         switch (cp0_reg) {
 180         case CCP0_STATUS:{
 181                         write_c0_status(val);
 182                         break;
 183                 }
 184         case CCP0_CAUSE:{
 185                         write_c0_cause(val);
 186                         break;
 187                 }
 188         }
 189 }
 190
 191 static void __init tx4927_irq_cp0_init(void)
 192 {
 193         int i;
 194
 195         TX4927_IRQ_DPRINTK(TX4927_IRQ_CP0_INIT, "beg=%d end=%d\n",
 196                            TX4927_IRQ_CP0_BEG, TX4927_IRQ_CP0_END);
 197
 198         for (i = TX4927_IRQ_CP0_BEG; i <= TX4927_IRQ_CP0_END; i++)
 199                 set_irq_chip(i, &tx4927_irq_cp0_type);
 200 }
 201
 202 static void tx4927_irq_cp0_enable(unsigned int irq)
 203 {
 204         TX4927_IRQ_DPRINTK(TX4927_IRQ_CP0_ENABLE, "irq=%d \n", irq);
 205
 206         tx4927_irq_cp0_modify(CCP0_STATUS, 0, tx4927_irq_cp0_mask(irq));
 207 }
 208
 209 static void tx4927_irq_cp0_disable(unsigned int irq)
 210 {
 211         TX4927_IRQ_DPRINTK(TX4927_IRQ_CP0_DISABLE, "irq=%d \n", irq);
 212
 213         tx4927_irq_cp0_modify(CCP0_STATUS, tx4927_irq_cp0_mask(irq), 0);
 214 }
 215
 216 static void tx4927_irq_cp0_end(unsigned int irq)
 217 {
 218         TX4927_IRQ_DPRINTK(TX4927_IRQ_CP0_ENDIRQ, "irq=%d \n", irq);
 219
 220         if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) {
 221                 tx4927_irq_cp0_enable(irq);
 222         }
 223 }
 224
 225 /*
 226  * Functions for pic
 227  */
 228 u32 tx4927_irq_pic_addr(int irq)
 229 {
 230         /* MVMCP -- need to formulize this */
 231         irq -= TX4927_IRQ_PIC_BEG;
 232         switch (irq) {
 233         case 17:
 234         case 16:
 235         case 1:
 236         case 0:
 237                 return (0xff1ff610);
 238
 239         case 19:
 240         case 18:
 241         case 3:
 242         case 2:
 243                 return (0xff1ff614);
 244
 245         case 21:
 246         case 20:
 247         case 5:
 248         case 4:
 249                 return (0xff1ff618);
 250
 251         case 23:
 252         case 22:
 253         case 7:
 254         case 6:
 255                 return (0xff1ff61c);
 256
 257         case 25:
 258         case 24:
 259         case 9:
 260         case 8:
 261                 return (0xff1ff620);
 262
 263         case 27:
 264         case 26:
 265         case 11:
 266         case 10:
 267                 return (0xff1ff624);
 268
 269         case 29:
 270         case 28:
 271         case 13:
 272         case 12:
 273                 return (0xff1ff628);
 274
 275         case 31:
 276         case 30:
 277         case 15:
 278         case 14:
 279                 return (0xff1ff62c);
 280
 281         }
 282         return (0);
 283 }
 284
 285 u32 tx4927_irq_pic_mask(int irq)
 286 {
 287         /* MVMCP -- need to formulize this */
 288         irq -= TX4927_IRQ_PIC_BEG;
 289         switch (irq) {
 290         case 31:
 291         case 29:
 292         case 27:
 293         case 25:
 294         case 23:
 295         case 21:
 296         case 19:
 297         case 17:{
 298                         return (0x07000000);
 299                 }
 300         case 30:
 301         case 28:
 302         case 26:
 303         case 24:
 304         case 22:
 305         case 20:
 306         case 18:
 307         case 16:{
 308                         return (0x00070000);
 309                 }
 310         case 15:
 311         case 13:
 312         case 11:
 313         case 9:
 314         case 7:
 315         case 5:
 316         case 3:
 317         case 1:{
 318                         return (0x00000700);
 319                 }
 320         case 14:
 321         case 12:
 322         case 10:
 323         case 8:
 324         case 6:
 325         case 4:
 326         case 2:
 327         case 0:{
 328                         return (0x00000007);
 329                 }
 330         }
 331         return (0x00000000);
 332 }
 333
 334 static void tx4927_irq_pic_modify(unsigned pic_reg, unsigned clr_bits,
 335         unsigned set_bits)
 336 {
 337         unsigned long val = 0;
 338
 339         val = TX4927_RD(pic_reg);
 340         val &= (~clr_bits);
 341         val |= (set_bits);
 342         TX4927_WR(pic_reg, val);
 343 }
 344
 345 static void __init tx4927_irq_pic_init(void)
 346 {
 347         int i;
 348
 349         TX4927_IRQ_DPRINTK(TX4927_IRQ_PIC_INIT, "beg=%d end=%d\n",
 350                            TX4927_IRQ_PIC_BEG, TX4927_IRQ_PIC_END);
 351
 352         for (i = TX4927_IRQ_PIC_BEG; i <= TX4927_IRQ_PIC_END; i++)
 353                 set_irq_chip(i, &tx4927_irq_pic_type);
 354
 355         setup_irq(TX4927_IRQ_NEST_PIC_ON_CP0, &tx4927_irq_pic_action);
 356
 357         TX4927_WR(0xff1ff640, 0x6);     /* irq level mask -- only accept hightest */
 358         TX4927_WR(0xff1ff600, TX4927_RD(0xff1ff600) | 0x1);     /* irq enable */
 359 }
 360
 361 static void tx4927_irq_pic_enable(unsigned int irq)
 362 {
 363         TX4927_IRQ_DPRINTK(TX4927_IRQ_PIC_ENABLE, "irq=%d\n", irq);
 364
 365         tx4927_irq_pic_modify(tx4927_irq_pic_addr(irq), 0,
 366                               tx4927_irq_pic_mask(irq));
 367 }
 368
 369 static void tx4927_irq_pic_disable(unsigned int irq)
 370 {
 371         TX4927_IRQ_DPRINTK(TX4927_IRQ_PIC_DISABLE, "irq=%d\n", irq);
 372
 373         tx4927_irq_pic_modify(tx4927_irq_pic_addr(irq),
 374                               tx4927_irq_pic_mask(irq), 0);
 375 }
 376
 377 static void tx4927_irq_pic_end(unsigned int irq)
 378 {
 379         TX4927_IRQ_DPRINTK(TX4927_IRQ_PIC_ENDIRQ, "irq=%d\n", irq);
 380
 381         if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) {
 382                 tx4927_irq_pic_enable(irq);
 383         }
 384 }
 385
 386 /*
 387  * Main init functions
 388  */
 389 void __init tx4927_irq_init(void)
 390 {
 391         TX4927_IRQ_DPRINTK(TX4927_IRQ_INIT, "-\n");
 392
 393         TX4927_IRQ_DPRINTK(TX4927_IRQ_INIT, "=Calling tx4927_irq_cp0_init()\n");
 394         tx4927_irq_cp0_init();
 395
 396         TX4927_IRQ_DPRINTK(TX4927_IRQ_INIT, "=Calling tx4927_irq_pic_init()\n");
 397         tx4927_irq_pic_init();
 398
 399         TX4927_IRQ_DPRINTK(TX4927_IRQ_INIT, "+\n");
 400 }
 401
 402 static int tx4927_irq_nested(void)
 403 {
 404         int sw_irq = 0;
 405         u32 level2;
 406
 407         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST1, "-\n");
 408
 409         level2 = TX4927_RD(0xff1ff6a0);
 410         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST2, "=level2a=0x%x\n", level2);
 411
 412         if ((level2 & 0x10000) == 0) {
 413                 level2 &= 0x1f;
 414                 TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST3, "=level2b=0x%x\n", level2);
 415
 416                 sw_irq = TX4927_IRQ_PIC_BEG + level2;
 417                 TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST3, "=sw_irq=%d\n", sw_irq);
 418
 419                 if (sw_irq == 27) {
 420                         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST4, "=irq-%d\n",
 421                                            sw_irq);
 422
 423 #ifdef CONFIG_TOSHIBA_RBTX4927
 424                         {
 425                                 sw_irq = toshiba_rbtx4927_irq_nested(sw_irq);
 426                         }
 427 #endif
 428
 429                         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST4, "=irq+%d\n",
 430                                            sw_irq);
 431                 }
 432         }
 433
 434         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST2, "=sw_irq=%d\n", sw_irq);
 435
 436         TX4927_IRQ_DPRINTK(TX4927_IRQ_NEST1, "+\n");
 437
 438         return (sw_irq);
 439 }
 440
 441 asmlinkage void plat_irq_dispatch(void)
 442 {
 443         unsigned int pending = read_c0_status() & read_c0_cause();
 444
 445         if (pending & STATUSF_IP7)                      /* cpu timer */
 446                 do_IRQ(TX4927_IRQ_CPU_TIMER);
 447         else if (pending & STATUSF_IP2) {               /* tx4927 pic */
 448                 unsigned int irq = tx4927_irq_nested();
 449
 450                 if (unlikely(irq == 0)) {
 451                         spurious_interrupt();
 452                         return;
 453                 }
 454                 do_IRQ(irq);
 455         } else if (pending & STATUSF_IP0)               /* user line 0 */
 456                 do_IRQ(TX4927_IRQ_USER0);
 457         else if (pending & STATUSF_IP1)                 /* user line 1 */
 458                 do_IRQ(TX4927_IRQ_USER1);
 459         else
 460                 spurious_interrupt();
 461 }