git.oblomov.eu Git - linux-2.6/blob - arch/ppc/amiga/cia.c

   1 /*
   2  *  arch/ppc/amiga/cia.c - CIA support
   3  *
   4  *  Copyright (C) 1996 Roman Zippel
   5  *
   6  *  The concept of some functions bases on the original Amiga OS function
   7  *
   8  * This file is subject to the terms and conditions of the GNU General Public
   9  * License.  See the file COPYING in the main directory of this archive
  10  * for more details.
  11  */
  12
  13 #include <linux/types.h>
  14 #include <linux/kernel.h>
  15 #include <linux/sched.h>
  16 #include <linux/interrupt.h>
  17 #include <linux/irq.h>
  18 #include <linux/kernel_stat.h>
  19 #include <linux/init.h>
  20
  21 #include <asm/irq.h>
  22 #include <asm/amigahw.h>
  23 #include <asm/amigaints.h>
  24
  25 struct ciabase {
  26         volatile struct CIA *cia;
  27         u_char icr_mask, icr_data;
  28         u_short int_mask;
  29         int handler_irq, cia_irq, server_irq;
  30         char *name;
  31 } ciaa_base = {
  32         &ciaa, 0, 0, IF_PORTS,
  33         IRQ_AMIGA_AUTO_2, IRQ_AMIGA_CIAA,
  34         IRQ_AMIGA_PORTS,
  35         "CIAA handler"
  36 }, ciab_base = {
  37         &ciab, 0, 0, IF_EXTER,
  38         IRQ_AMIGA_AUTO_6, IRQ_AMIGA_CIAB,
  39         IRQ_AMIGA_EXTER,
  40         "CIAB handler"
  41 };
  42
  43 #define CIA_SET_BASE_ADJUST_IRQ(base, irq)      \
  44 do {                                            \
  45         if (irq >= IRQ_AMIGA_CIAB) {            \
  46                 base = &ciab_base;              \
  47                 irq -= IRQ_AMIGA_CIAB;          \
  48         } else {                                \
  49                 base = &ciaa_base;              \
  50                 irq -= IRQ_AMIGA_CIAA;          \
  51         }                                       \
  52 } while (0)
  53
  54 /*
  55  *  Cause or clear CIA interrupts, return old interrupt status.
  56  */
  57
  58 static unsigned char cia_set_irq_private(struct ciabase *base,
  59                                          unsigned char mask)
  60 {
  61         u_char old;
  62
  63         old = (base->icr_data |= base->cia->icr);
  64         if (mask & CIA_ICR_SETCLR)
  65                 base->icr_data |= mask;
  66         else
  67                 base->icr_data &= ~mask;
  68         if (base->icr_data & base->icr_mask)
  69                 custom.intreq = IF_SETCLR | base->int_mask;
  70         return old & base->icr_mask;
  71 }
  72
  73 unsigned char cia_set_irq(unsigned int irq, int set)
  74 {
  75         struct ciabase *base;
  76         unsigned char mask;
  77
  78         if (irq >= IRQ_AMIGA_CIAB)
  79                 mask = (1 << (irq - IRQ_AMIGA_CIAB));
  80         else
  81                 mask = (1 << (irq - IRQ_AMIGA_CIAA));
  82         mask |= (set) ? CIA_ICR_SETCLR : 0;
  83
  84         CIA_SET_BASE_ADJUST_IRQ(base, irq);
  85
  86         return cia_set_irq_private(base, mask);
  87 }
  88
  89 unsigned char cia_get_irq_mask(unsigned int irq)
  90 {
  91         struct ciabase *base;
  92
  93         CIA_SET_BASE_ADJUST_IRQ(base, irq);
  94
  95         return base->cia->icr;
  96 }
  97
  98 /*
  99  *  Enable or disable CIA interrupts, return old interrupt mask.
 100  */
 101
 102 static unsigned char cia_able_irq_private(struct ciabase *base,
 103                                           unsigned char mask)
 104 {
 105         u_char old;
 106
 107         old = base->icr_mask;
 108         base->icr_data |= base->cia->icr;
 109         base->cia->icr = mask;
 110         if (mask & CIA_ICR_SETCLR)
 111                 base->icr_mask |= mask;
 112         else
 113                 base->icr_mask &= ~mask;
 114         base->icr_mask &= CIA_ICR_ALL;
 115
 116         if (base->icr_data & base->icr_mask)
 117                 custom.intreq = IF_SETCLR | base->int_mask;
 118         return old;
 119 }
 120
 121 unsigned char cia_able_irq(unsigned int irq, int enable)
 122 {
 123         struct ciabase *base;
 124         unsigned char mask;
 125
 126         if (irq >= IRQ_AMIGA_CIAB)
 127                 mask = (1 << (irq - IRQ_AMIGA_CIAB));
 128         else
 129                 mask = (1 << (irq - IRQ_AMIGA_CIAA));
 130         mask |= (enable) ? CIA_ICR_SETCLR : 0;
 131
 132         CIA_SET_BASE_ADJUST_IRQ(base, irq);
 133
 134         return cia_able_irq_private(base, mask);
 135 }
 136
 137 static void cia_handler(int irq, void *dev_id, struct pt_regs *fp)
 138 {
 139         struct ciabase *base = (struct ciabase *)dev_id;
 140         irq_desc_t *desc;
 141         struct irqaction *action;
 142         int i;
 143         unsigned char ints;
 144
 145         irq = base->cia_irq;
 146         desc = irq_desc + irq;
 147         ints = cia_set_irq_private(base, CIA_ICR_ALL);
 148         custom.intreq = base->int_mask;
 149         for (i = 0; i < CIA_IRQS; i++, irq++) {
 150                 if (ints & 1) {
 151                         kstat_cpu(0).irqs[irq]++;
 152                         action = desc->action;
 153                         action->handler(irq, action->dev_id, fp);
 154                 }
 155                 ints >>= 1;
 156                 desc++;
 157         }
 158         amiga_do_irq_list(base->server_irq, fp);
 159 }
 160
 161 void __init cia_init_IRQ(struct ciabase *base)
 162 {
 163         extern struct irqaction amiga_sys_irqaction[AUTO_IRQS];
 164         struct irqaction *action;
 165
 166         /* clear any pending interrupt and turn off all interrupts */
 167         cia_set_irq_private(base, CIA_ICR_ALL);
 168         cia_able_irq_private(base, CIA_ICR_ALL);
 169
 170         /* install CIA handler */
 171         action = &amiga_sys_irqaction[base->handler_irq-IRQ_AMIGA_AUTO];
 172         action->handler = cia_handler;
 173         action->dev_id = base;
 174         action->name = base->name;
 175         setup_irq(base->handler_irq, &amiga_sys_irqaction[base->handler_irq-IRQ_AMIGA_AUTO]);
 176
 177         custom.intena = IF_SETCLR | base->int_mask;
 178 }