diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/m68k/amiga/cia.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/m68k/amiga/cia.c')
-rw-r--r-- | arch/m68k/amiga/cia.c | 180 |
1 files changed, 180 insertions, 0 deletions
diff --git a/arch/m68k/amiga/cia.c b/arch/m68k/amiga/cia.c new file mode 100644 index 000000000000..7d55682615e3 --- /dev/null +++ b/arch/m68k/amiga/cia.c | |||
@@ -0,0 +1,180 @@ | |||
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> | ||
21 | |||
22 | #include <asm/irq.h> | ||
23 | #include <asm/amigahw.h> | ||
24 | #include <asm/amigaints.h> | ||
25 | |||
26 | struct ciabase { | ||
27 | volatile struct CIA *cia; | ||
28 | unsigned char icr_mask, icr_data; | ||
29 | unsigned short int_mask; | ||
30 | int handler_irq, cia_irq, server_irq; | ||
31 | char *name; | ||
32 | irq_handler_t irq_list[CIA_IRQS]; | ||
33 | } ciaa_base = { | ||
34 | .cia = &ciaa, | ||
35 | .int_mask = IF_PORTS, | ||
36 | .handler_irq = IRQ_AMIGA_AUTO_2, | ||
37 | .cia_irq = IRQ_AMIGA_CIAA, | ||
38 | .server_irq = IRQ_AMIGA_PORTS, | ||
39 | .name = "CIAA handler" | ||
40 | }, ciab_base = { | ||
41 | .cia = &ciab, | ||
42 | .int_mask = IF_EXTER, | ||
43 | .handler_irq = IRQ_AMIGA_AUTO_6, | ||
44 | .cia_irq = IRQ_AMIGA_CIAB, | ||
45 | .server_irq = IRQ_AMIGA_EXTER, | ||
46 | .name = "CIAB handler" | ||
47 | }; | ||
48 | |||
49 | /* | ||
50 | * Cause or clear CIA interrupts, return old interrupt status. | ||
51 | */ | ||
52 | |||
53 | unsigned char cia_set_irq(struct ciabase *base, unsigned char mask) | ||
54 | { | ||
55 | unsigned char old; | ||
56 | |||
57 | old = (base->icr_data |= base->cia->icr); | ||
58 | if (mask & CIA_ICR_SETCLR) | ||
59 | base->icr_data |= mask; | ||
60 | else | ||
61 | base->icr_data &= ~mask; | ||
62 | if (base->icr_data & base->icr_mask) | ||
63 | custom.intreq = IF_SETCLR | base->int_mask; | ||
64 | return old & base->icr_mask; | ||
65 | } | ||
66 | |||
67 | /* | ||
68 | * Enable or disable CIA interrupts, return old interrupt mask, | ||
69 | * interrupts will only be enabled if a handler exists | ||
70 | */ | ||
71 | |||
72 | unsigned char cia_able_irq(struct ciabase *base, unsigned char mask) | ||
73 | { | ||
74 | unsigned char old, tmp; | ||
75 | int i; | ||
76 | |||
77 | old = base->icr_mask; | ||
78 | base->icr_data |= base->cia->icr; | ||
79 | base->cia->icr = mask; | ||
80 | if (mask & CIA_ICR_SETCLR) | ||
81 | base->icr_mask |= mask; | ||
82 | else | ||
83 | base->icr_mask &= ~mask; | ||
84 | base->icr_mask &= CIA_ICR_ALL; | ||
85 | for (i = 0, tmp = 1; i < CIA_IRQS; i++, tmp <<= 1) { | ||
86 | if ((tmp & base->icr_mask) && !base->irq_list[i].handler) { | ||
87 | base->icr_mask &= ~tmp; | ||
88 | base->cia->icr = tmp; | ||
89 | } | ||
90 | } | ||
91 | if (base->icr_data & base->icr_mask) | ||
92 | custom.intreq = IF_SETCLR | base->int_mask; | ||
93 | return old; | ||
94 | } | ||
95 | |||
96 | int cia_request_irq(struct ciabase *base, unsigned int irq, | ||
97 | irqreturn_t (*handler)(int, void *, struct pt_regs *), | ||
98 | unsigned long flags, const char *devname, void *dev_id) | ||
99 | { | ||
100 | unsigned char mask; | ||
101 | |||
102 | base->irq_list[irq].handler = handler; | ||
103 | base->irq_list[irq].flags = flags; | ||
104 | base->irq_list[irq].dev_id = dev_id; | ||
105 | base->irq_list[irq].devname = devname; | ||
106 | |||
107 | /* enable the interrupt */ | ||
108 | mask = 1 << irq; | ||
109 | cia_set_irq(base, mask); | ||
110 | cia_able_irq(base, CIA_ICR_SETCLR | mask); | ||
111 | return 0; | ||
112 | } | ||
113 | |||
114 | void cia_free_irq(struct ciabase *base, unsigned int irq, void *dev_id) | ||
115 | { | ||
116 | if (base->irq_list[irq].dev_id != dev_id) | ||
117 | printk("%s: removing probably wrong IRQ %i from %s\n", | ||
118 | __FUNCTION__, base->cia_irq + irq, | ||
119 | base->irq_list[irq].devname); | ||
120 | |||
121 | base->irq_list[irq].handler = NULL; | ||
122 | base->irq_list[irq].flags = 0; | ||
123 | |||
124 | cia_able_irq(base, 1 << irq); | ||
125 | } | ||
126 | |||
127 | static irqreturn_t cia_handler(int irq, void *dev_id, struct pt_regs *fp) | ||
128 | { | ||
129 | struct ciabase *base = (struct ciabase *)dev_id; | ||
130 | int mach_irq, i; | ||
131 | unsigned char ints; | ||
132 | |||
133 | mach_irq = base->cia_irq; | ||
134 | irq = SYS_IRQS + mach_irq; | ||
135 | ints = cia_set_irq(base, CIA_ICR_ALL); | ||
136 | custom.intreq = base->int_mask; | ||
137 | for (i = 0; i < CIA_IRQS; i++, irq++, mach_irq++) { | ||
138 | if (ints & 1) { | ||
139 | kstat_cpu(0).irqs[irq]++; | ||
140 | base->irq_list[i].handler(mach_irq, base->irq_list[i].dev_id, fp); | ||
141 | } | ||
142 | ints >>= 1; | ||
143 | } | ||
144 | amiga_do_irq_list(base->server_irq, fp); | ||
145 | return IRQ_HANDLED; | ||
146 | } | ||
147 | |||
148 | void __init cia_init_IRQ(struct ciabase *base) | ||
149 | { | ||
150 | int i; | ||
151 | |||
152 | /* init isr handlers */ | ||
153 | for (i = 0; i < CIA_IRQS; i++) { | ||
154 | base->irq_list[i].handler = NULL; | ||
155 | base->irq_list[i].flags = 0; | ||
156 | } | ||
157 | |||
158 | /* clear any pending interrupt and turn off all interrupts */ | ||
159 | cia_set_irq(base, CIA_ICR_ALL); | ||
160 | cia_able_irq(base, CIA_ICR_ALL); | ||
161 | |||
162 | /* install CIA handler */ | ||
163 | request_irq(base->handler_irq, cia_handler, 0, base->name, base); | ||
164 | |||
165 | custom.intena = IF_SETCLR | base->int_mask; | ||
166 | } | ||
167 | |||
168 | int cia_get_irq_list(struct ciabase *base, struct seq_file *p) | ||
169 | { | ||
170 | int i, j; | ||
171 | |||
172 | j = base->cia_irq; | ||
173 | for (i = 0; i < CIA_IRQS; i++) { | ||
174 | seq_printf(p, "cia %2d: %10d ", j + i, | ||
175 | kstat_cpu(0).irqs[SYS_IRQS + j + i]); | ||
176 | seq_puts(p, " "); | ||
177 | seq_printf(p, "%s\n", base->irq_list[i].devname); | ||
178 | } | ||
179 | return 0; | ||
180 | } | ||