[PATCH] Check ieee80211softmac_auth_resp kmalloc result
[linux-2.6/libata-dev.git] / arch / m68k / mac / psc.c
blob15378a5878c94925f1cf88cb2556b58ee150ad14
1 /*
2 * Apple Peripheral System Controller (PSC)
4 * The PSC is used on the AV Macs to control IO functions not handled
5 * by the VIAs (Ethernet, DSP, SCC).
7 * TO DO:
9 * Try to figure out what's going on in pIFR5 and pIFR6. There seem to be
10 * persisant interrupt conditions in those registers and I have no idea what
11 * they are. Granted it doesn't affect since we're not enabling any interrupts
12 * on those levels at the moment, but it would be nice to know. I have a feeling
13 * they aren't actually interrupt lines but data lines (to the DSP?)
16 #include <linux/types.h>
17 #include <linux/kernel.h>
18 #include <linux/mm.h>
19 #include <linux/delay.h>
20 #include <linux/init.h>
22 #include <asm/traps.h>
23 #include <asm/bootinfo.h>
24 #include <asm/macintosh.h>
25 #include <asm/macints.h>
26 #include <asm/mac_psc.h>
28 #define DEBUG_PSC
30 int psc_present;
31 volatile __u8 *psc;
33 irqreturn_t psc_irq(int, void *);
36 * Debugging dump, used in various places to see what's going on.
39 void psc_debug_dump(void)
41 int i;
43 if (!psc_present) return;
44 for (i = 0x30 ; i < 0x70 ; i += 0x10) {
45 printk("PSC #%d: IFR = 0x%02X IER = 0x%02X\n",
46 i >> 4,
47 (int) psc_read_byte(pIFRbase + i),
48 (int) psc_read_byte(pIERbase + i));
53 * Try to kill all DMA channels on the PSC. Not sure how this his
54 * supposed to work; this is code lifted from macmace.c and then
55 * expanded to cover what I think are the other 7 channels.
58 void psc_dma_die_die_die(void)
60 int i;
62 printk("Killing all PSC DMA channels...");
63 for (i = 0 ; i < 9 ; i++) {
64 psc_write_word(PSC_CTL_BASE + (i << 4), 0x8800);
65 psc_write_word(PSC_CTL_BASE + (i << 4), 0x1000);
66 psc_write_word(PSC_CMD_BASE + (i << 5), 0x1100);
67 psc_write_word(PSC_CMD_BASE + (i << 5) + 0x10, 0x1100);
69 printk("done!\n");
73 * Initialize the PSC. For now this just involves shutting down all
74 * interrupt sources using the IERs.
77 void __init psc_init(void)
79 int i;
81 if (macintosh_config->ident != MAC_MODEL_C660
82 && macintosh_config->ident != MAC_MODEL_Q840)
84 psc = NULL;
85 psc_present = 0;
86 return;
90 * The PSC is always at the same spot, but using psc
91 * keeps things consisant with the psc_xxxx functions.
94 psc = (void *) PSC_BASE;
95 psc_present = 1;
97 printk("PSC detected at %p\n", psc);
99 psc_dma_die_die_die();
101 #ifdef DEBUG_PSC
102 psc_debug_dump();
103 #endif
105 * Mask and clear all possible interrupts
108 for (i = 0x30 ; i < 0x70 ; i += 0x10) {
109 psc_write_byte(pIERbase + i, 0x0F);
110 psc_write_byte(pIFRbase + i, 0x0F);
115 * Register the PSC interrupt dispatchers for autovector interrupts 3-6.
118 void __init psc_register_interrupts(void)
120 request_irq(IRQ_AUTO_3, psc_irq, 0, "psc3", (void *) 0x30);
121 request_irq(IRQ_AUTO_4, psc_irq, 0, "psc4", (void *) 0x40);
122 request_irq(IRQ_AUTO_5, psc_irq, 0, "psc5", (void *) 0x50);
123 request_irq(IRQ_AUTO_6, psc_irq, 0, "psc6", (void *) 0x60);
127 * PSC interrupt handler. It's a lot like the VIA interrupt handler.
130 irqreturn_t psc_irq(int irq, void *dev_id)
132 int pIFR = pIFRbase + ((int) dev_id);
133 int pIER = pIERbase + ((int) dev_id);
134 int base_irq;
135 int irq_bit,i;
136 unsigned char events;
138 base_irq = irq << 3;
140 #ifdef DEBUG_IRQS
141 printk("psc_irq: irq %d pIFR = 0x%02X pIER = 0x%02X\n",
142 irq, (int) psc_read_byte(pIFR), (int) psc_read_byte(pIER));
143 #endif
145 events = psc_read_byte(pIFR) & psc_read_byte(pIER) & 0xF;
146 if (!events)
147 return IRQ_NONE;
149 for (i = 0, irq_bit = 1 ; i < 4 ; i++, irq_bit <<= 1) {
150 if (events & irq_bit) {
151 psc_write_byte(pIER, irq_bit);
152 m68k_handle_int(base_irq + i);
153 psc_write_byte(pIFR, irq_bit);
154 psc_write_byte(pIER, irq_bit | 0x80);
157 return IRQ_HANDLED;
160 void psc_irq_enable(int irq) {
161 int irq_src = IRQ_SRC(irq);
162 int irq_idx = IRQ_IDX(irq);
163 int pIER = pIERbase + (irq_src << 4);
165 #ifdef DEBUG_IRQUSE
166 printk("psc_irq_enable(%d)\n", irq);
167 #endif
168 psc_write_byte(pIER, (1 << irq_idx) | 0x80);
171 void psc_irq_disable(int irq) {
172 int irq_src = IRQ_SRC(irq);
173 int irq_idx = IRQ_IDX(irq);
174 int pIER = pIERbase + (irq_src << 4);
176 #ifdef DEBUG_IRQUSE
177 printk("psc_irq_disable(%d)\n", irq);
178 #endif
179 psc_write_byte(pIER, 1 << irq_idx);
182 void psc_irq_clear(int irq) {
183 int irq_src = IRQ_SRC(irq);
184 int irq_idx = IRQ_IDX(irq);
185 int pIFR = pIERbase + (irq_src << 4);
187 psc_write_byte(pIFR, 1 << irq_idx);
190 int psc_irq_pending(int irq)
192 int irq_src = IRQ_SRC(irq);
193 int irq_idx = IRQ_IDX(irq);
194 int pIFR = pIERbase + (irq_src << 4);
196 return psc_read_byte(pIFR) & (1 << irq_idx);