arch/h8300/kernel/irq_s.c

   1 /*
   2  * linux/arch/h8300/kernel/irq_s.c
   3  *
   4  * Copyright 2014 Yoshinori Sato <ysato@users.sourceforge.jp>
   5  */
   6
   7 #include <linux/irq.h>
   8 #include <asm/io.h>
   9 #define IPRA 0xfffe00
  10
  11 static const unsigned char ipr_table[] = {
  12         0x03, 0x02, 0x01, 0x00, 0x13, 0x12, 0x11, 0x10, /* 16 - 23 */
  13         0x23, 0x22, 0x21, 0x20, 0x33, 0x32, 0x31, 0x30, /* 24 - 31 */
  14         0x43, 0x42, 0x41, 0x40, 0x53, 0x53, 0x52, 0x52, /* 32 - 39 */
  15         0x51, 0x51, 0x51, 0x51, 0x51, 0x51, 0x51, 0x51, /* 40 - 47 */
  16         0x50, 0x50, 0x50, 0x50, 0x63, 0x63, 0x63, 0x63, /* 48 - 55 */
  17         0x62, 0x62, 0x62, 0x62, 0x62, 0x62, 0x62, 0x62, /* 56 - 63 */
  18         0x61, 0x61, 0x61, 0x61, 0x60, 0x60, 0x60, 0x60, /* 64 - 71 */
  19         0x73, 0x73, 0x73, 0x73, 0x72, 0x72, 0x72, 0x72, /* 72 - 79 */
  20         0x71, 0x71, 0x71, 0x71, 0x70, 0x83, 0x82, 0x81, /* 80 - 87 */
  21         0x80, 0x80, 0x80, 0x80, 0x93, 0x93, 0x93, 0x93, /* 88 - 95 */
  22         0x92, 0x92, 0x92, 0x92, 0x91, 0x91, 0x91, 0x91, /* 96 - 103 */
  23         0x90, 0x90, 0x90, 0x90, 0xa3, 0xa3, 0xa3, 0xa3, /* 104 - 111 */
  24         0xa2, 0xa2, 0xa2, 0xa2, 0xa1, 0xa1, 0xa1, 0xa1, /* 112 - 119 */
  25         0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, /* 120 - 127 */
  26 };
  27
  28 static void h8s_disable_irq(struct irq_data *data)
  29 {
  30         int pos;
  31         unsigned int addr;
  32         unsigned short pri;
  33         int irq = data->irq;
  34
  35         addr = IPRA + ((ipr_table[irq - 16] & 0xf0) >> 3);
  36         pos = (ipr_table[irq - 16] & 0x0f) * 4;
  37         pri = ~(0x000f << pos);
  38         pri &= ctrl_inw(addr);
  39         ctrl_outw(pri, addr);
  40 }
  41
  42 static void h8s_enable_irq(struct irq_data *data)
  43 {
  44         int pos;
  45         unsigned int addr;
  46         unsigned short pri;
  47         int irq = data->irq;
  48
  49         addr = IPRA + ((ipr_table[irq - 16] & 0xf0) >> 3);
  50         pos = (ipr_table[irq - 16] & 0x0f) * 4;
  51         pri = ~(0x000f << pos);
  52         pri &= ctrl_inw(addr);
  53         pri |= 1 << pos;
  54         ctrl_outw(pri, addr);
  55 }
  56
  57 struct irq_chip h8s_irq_chip = {
  58         .name           = "H8S-INTC",
  59         .irq_enable     = h8s_enable_irq,
  60         .irq_disable    = h8s_disable_irq,
  61 };
  62
  63 void __init h8300_init_ipr(void)
  64 {
  65         int n;
  66         int i;
  67         /* All interrupt priority is 1 */
  68         /* IPRA to IPRK */
  69         for (n = 0; n <= 'k' - 'a'; n++)
  70                 ctrl_outw(0x1111, IPRA + (n * 2));
  71 }