Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/arch/m68k/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/errno.h> | |
17 | #include <linux/kernel_stat.h> | |
18 | #include <linux/init.h> | |
19 | #include <linux/seq_file.h> | |
20 | #include <linux/interrupt.h> | |
14b4319a | 21 | #include <linux/irq.h> |
1da177e4 LT |
22 | |
23 | #include <asm/irq.h> | |
24 | #include <asm/amigahw.h> | |
25 | #include <asm/amigaints.h> | |
26 | ||
27 | struct ciabase { | |
28 | volatile struct CIA *cia; | |
29 | unsigned char icr_mask, icr_data; | |
30 | unsigned short int_mask; | |
31 | int handler_irq, cia_irq, server_irq; | |
32 | char *name; | |
1da177e4 LT |
33 | } ciaa_base = { |
34 | .cia = &ciaa, | |
35 | .int_mask = IF_PORTS, | |
74be8d08 | 36 | .handler_irq = IRQ_AMIGA_PORTS, |
1da177e4 | 37 | .cia_irq = IRQ_AMIGA_CIAA, |
74be8d08 | 38 | .name = "CIAA" |
1da177e4 LT |
39 | }, ciab_base = { |
40 | .cia = &ciab, | |
41 | .int_mask = IF_EXTER, | |
74be8d08 | 42 | .handler_irq = IRQ_AMIGA_EXTER, |
1da177e4 | 43 | .cia_irq = IRQ_AMIGA_CIAB, |
74be8d08 | 44 | .name = "CIAB" |
1da177e4 LT |
45 | }; |
46 | ||
47 | /* | |
48 | * Cause or clear CIA interrupts, return old interrupt status. | |
49 | */ | |
50 | ||
51 | unsigned char cia_set_irq(struct ciabase *base, unsigned char mask) | |
52 | { | |
53 | unsigned char old; | |
54 | ||
55 | old = (base->icr_data |= base->cia->icr); | |
56 | if (mask & CIA_ICR_SETCLR) | |
57 | base->icr_data |= mask; | |
58 | else | |
59 | base->icr_data &= ~mask; | |
60 | if (base->icr_data & base->icr_mask) | |
b4290a23 | 61 | amiga_custom.intreq = IF_SETCLR | base->int_mask; |
1da177e4 LT |
62 | return old & base->icr_mask; |
63 | } | |
64 | ||
65 | /* | |
66 | * Enable or disable CIA interrupts, return old interrupt mask, | |
1da177e4 LT |
67 | */ |
68 | ||
69 | unsigned char cia_able_irq(struct ciabase *base, unsigned char mask) | |
70 | { | |
74be8d08 | 71 | unsigned char old; |
1da177e4 LT |
72 | |
73 | old = base->icr_mask; | |
74 | base->icr_data |= base->cia->icr; | |
75 | base->cia->icr = mask; | |
76 | if (mask & CIA_ICR_SETCLR) | |
77 | base->icr_mask |= mask; | |
78 | else | |
79 | base->icr_mask &= ~mask; | |
80 | base->icr_mask &= CIA_ICR_ALL; | |
1da177e4 | 81 | if (base->icr_data & base->icr_mask) |
b4290a23 | 82 | amiga_custom.intreq = IF_SETCLR | base->int_mask; |
1da177e4 LT |
83 | return old; |
84 | } | |
85 | ||
2850bc27 | 86 | static irqreturn_t cia_handler(int irq, void *dev_id) |
1da177e4 | 87 | { |
15aafa2f | 88 | struct ciabase *base = dev_id; |
74be8d08 | 89 | int mach_irq; |
1da177e4 LT |
90 | unsigned char ints; |
91 | ||
92 | mach_irq = base->cia_irq; | |
1da177e4 | 93 | ints = cia_set_irq(base, CIA_ICR_ALL); |
b4290a23 | 94 | amiga_custom.intreq = base->int_mask; |
74be8d08 RZ |
95 | for (; ints; mach_irq++, ints >>= 1) { |
96 | if (ints & 1) | |
1425df87 | 97 | generic_handle_irq(mach_irq); |
1da177e4 | 98 | } |
1da177e4 LT |
99 | return IRQ_HANDLED; |
100 | } | |
101 | ||
e8abf5e7 | 102 | static void cia_irq_enable(struct irq_data *data) |
1da177e4 | 103 | { |
e8abf5e7 | 104 | unsigned int irq = data->irq; |
74be8d08 | 105 | unsigned char mask; |
1da177e4 | 106 | |
74be8d08 RZ |
107 | if (irq >= IRQ_AMIGA_CIAB) { |
108 | mask = 1 << (irq - IRQ_AMIGA_CIAB); | |
109 | cia_set_irq(&ciab_base, mask); | |
110 | cia_able_irq(&ciab_base, CIA_ICR_SETCLR | mask); | |
111 | } else { | |
112 | mask = 1 << (irq - IRQ_AMIGA_CIAA); | |
113 | cia_set_irq(&ciaa_base, mask); | |
114 | cia_able_irq(&ciaa_base, CIA_ICR_SETCLR | mask); | |
1da177e4 | 115 | } |
74be8d08 | 116 | } |
1da177e4 | 117 | |
e8abf5e7 | 118 | static void cia_irq_disable(struct irq_data *data) |
74be8d08 | 119 | { |
e8abf5e7 GU |
120 | unsigned int irq = data->irq; |
121 | ||
74be8d08 RZ |
122 | if (irq >= IRQ_AMIGA_CIAB) |
123 | cia_able_irq(&ciab_base, 1 << (irq - IRQ_AMIGA_CIAB)); | |
124 | else | |
125 | cia_able_irq(&ciaa_base, 1 << (irq - IRQ_AMIGA_CIAA)); | |
126 | } | |
1da177e4 | 127 | |
c288bf25 | 128 | static struct irq_chip cia_irq_chip = { |
74be8d08 | 129 | .name = "cia", |
e8abf5e7 GU |
130 | .irq_enable = cia_irq_enable, |
131 | .irq_disable = cia_irq_disable, | |
74be8d08 RZ |
132 | }; |
133 | ||
134 | /* | |
135 | * Override auto irq 2 & 6 and use them as general chain | |
136 | * for external interrupts, we link the CIA interrupt sources | |
137 | * into this chain. | |
138 | */ | |
1da177e4 | 139 | |
e8abf5e7 | 140 | static void auto_irq_enable(struct irq_data *data) |
74be8d08 | 141 | { |
e8abf5e7 | 142 | switch (data->irq) { |
74be8d08 RZ |
143 | case IRQ_AUTO_2: |
144 | amiga_custom.intena = IF_SETCLR | IF_PORTS; | |
145 | break; | |
146 | case IRQ_AUTO_6: | |
147 | amiga_custom.intena = IF_SETCLR | IF_EXTER; | |
148 | break; | |
149 | } | |
1da177e4 LT |
150 | } |
151 | ||
e8abf5e7 | 152 | static void auto_irq_disable(struct irq_data *data) |
1da177e4 | 153 | { |
e8abf5e7 | 154 | switch (data->irq) { |
74be8d08 RZ |
155 | case IRQ_AUTO_2: |
156 | amiga_custom.intena = IF_PORTS; | |
157 | break; | |
158 | case IRQ_AUTO_6: | |
159 | amiga_custom.intena = IF_EXTER; | |
160 | break; | |
1da177e4 | 161 | } |
74be8d08 RZ |
162 | } |
163 | ||
c288bf25 | 164 | static struct irq_chip auto_irq_chip = { |
74be8d08 | 165 | .name = "auto", |
e8abf5e7 GU |
166 | .irq_enable = auto_irq_enable, |
167 | .irq_disable = auto_irq_disable, | |
74be8d08 RZ |
168 | }; |
169 | ||
170 | void __init cia_init_IRQ(struct ciabase *base) | |
171 | { | |
edb34725 GU |
172 | m68k_setup_irq_controller(&cia_irq_chip, handle_simple_irq, |
173 | base->cia_irq, CIA_IRQS); | |
74be8d08 RZ |
174 | |
175 | /* clear any pending interrupt and turn off all interrupts */ | |
176 | cia_set_irq(base, CIA_ICR_ALL); | |
177 | cia_able_irq(base, CIA_ICR_ALL); | |
178 | ||
179 | /* override auto int and install CIA handler */ | |
edb34725 GU |
180 | m68k_setup_irq_controller(&auto_irq_chip, handle_simple_irq, |
181 | base->handler_irq, 1); | |
e8abf5e7 | 182 | m68k_irq_startup_irq(base->handler_irq); |
66acd258 GU |
183 | if (request_irq(base->handler_irq, cia_handler, IRQF_SHARED, |
184 | base->name, base)) | |
185 | pr_err("Couldn't register %s interrupt\n", base->name); | |
1da177e4 | 186 | } |