KVM: Fix unlikely kvm_create vs decache_vcpus_on_cpu race
[linux-2.6] / drivers / parport / parport_atari.c
1 /* Low-level parallel port routines for the Atari builtin port
2  *
3  * Author: Andreas Schwab <schwab@issan.informatik.uni-dortmund.de>
4  *
5  * Based on parport_amiga.c.
6  *
7  * The built-in Atari parallel port provides one port at a fixed address
8  * with 8 output data lines (D0 - D7), 1 output control line (STROBE)
9  * and 1 input status line (BUSY) able to cause an interrupt.
10  */
11
12 #include <linux/module.h>
13 #include <linux/init.h>
14 #include <linux/parport.h>
15 #include <linux/interrupt.h>
16 #include <asm/setup.h>
17 #include <asm/atarihw.h>
18 #include <asm/irq.h>
19 #include <asm/atariints.h>
20
21 static struct parport *this_port = NULL;
22
23 static unsigned char
24 parport_atari_read_data(struct parport *p)
25 {
26         unsigned long flags;
27         unsigned char data;
28
29         local_irq_save(flags);
30         sound_ym.rd_data_reg_sel = 15;
31         data = sound_ym.rd_data_reg_sel;
32         local_irq_restore(flags);
33         return data;
34 }
35
36 static void
37 parport_atari_write_data(struct parport *p, unsigned char data)
38 {
39         unsigned long flags;
40
41         local_irq_save(flags);
42         sound_ym.rd_data_reg_sel = 15;
43         sound_ym.wd_data = data;
44         local_irq_restore(flags);
45 }
46
47 static unsigned char
48 parport_atari_read_control(struct parport *p)
49 {
50         unsigned long flags;
51         unsigned char control = 0;
52
53         local_irq_save(flags);
54         sound_ym.rd_data_reg_sel = 14;
55         if (!(sound_ym.rd_data_reg_sel & (1 << 5)))
56                 control = PARPORT_CONTROL_STROBE;
57         local_irq_restore(flags);
58         return control;
59 }
60
61 static void
62 parport_atari_write_control(struct parport *p, unsigned char control)
63 {
64         unsigned long flags;
65
66         local_irq_save(flags);
67         sound_ym.rd_data_reg_sel = 14;
68         if (control & PARPORT_CONTROL_STROBE)
69                 sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~(1 << 5);
70         else
71                 sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5);
72         local_irq_restore(flags);
73 }
74
75 static unsigned char
76 parport_atari_frob_control(struct parport *p, unsigned char mask,
77                            unsigned char val)
78 {
79         unsigned char old = parport_atari_read_control(p);
80         parport_atari_write_control(p, (old & ~mask) ^ val);
81         return old;
82 }
83
84 static unsigned char
85 parport_atari_read_status(struct parport *p)
86 {
87         return ((mfp.par_dt_reg & 1 ? 0 : PARPORT_STATUS_BUSY) |
88                 PARPORT_STATUS_SELECT | PARPORT_STATUS_ERROR);
89 }
90
91 static void
92 parport_atari_init_state(struct pardevice *d, struct parport_state *s)
93 {
94 }
95
96 static void
97 parport_atari_save_state(struct parport *p, struct parport_state *s)
98 {
99 }
100
101 static void
102 parport_atari_restore_state(struct parport *p, struct parport_state *s)
103 {
104 }
105
106 static irqreturn_t
107 parport_atari_interrupt(int irq, void *dev_id)
108 {
109         parport_generic_irq(irq, (struct parport *) dev_id);
110         return IRQ_HANDLED;
111 }
112
113 static void
114 parport_atari_enable_irq(struct parport *p)
115 {
116         enable_irq(IRQ_MFP_BUSY);
117 }
118
119 static void
120 parport_atari_disable_irq(struct parport *p)
121 {
122         disable_irq(IRQ_MFP_BUSY);
123 }
124
125 static void
126 parport_atari_data_forward(struct parport *p)
127 {
128         unsigned long flags;
129
130         local_irq_save(flags);
131         /* Soundchip port B as output. */
132         sound_ym.rd_data_reg_sel = 7;
133         sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x40;
134         local_irq_restore(flags);
135 }
136
137 static void
138 parport_atari_data_reverse(struct parport *p)
139 {
140 #if 0 /* too dangerous, can kill sound chip */
141         unsigned long flags;
142
143         local_irq_save(flags);
144         /* Soundchip port B as input. */
145         sound_ym.rd_data_reg_sel = 7;
146         sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~0x40;
147         local_irq_restore(flags);
148 #endif
149 }
150
151 static struct parport_operations parport_atari_ops = {
152         .write_data     = parport_atari_write_data,
153         .read_data      = parport_atari_read_data,
154
155         .write_control  = parport_atari_write_control,
156         .read_control   = parport_atari_read_control,
157         .frob_control   = parport_atari_frob_control,
158
159         .read_status    = parport_atari_read_status,
160
161         .enable_irq     = parport_atari_enable_irq,
162         .disable_irq    = parport_atari_disable_irq,
163
164         .data_forward   = parport_atari_data_forward,
165         .data_reverse   = parport_atari_data_reverse,
166
167         .init_state     = parport_atari_init_state,
168         .save_state     = parport_atari_save_state,
169         .restore_state  = parport_atari_restore_state,
170
171         .epp_write_data = parport_ieee1284_epp_write_data,
172         .epp_read_data  = parport_ieee1284_epp_read_data,
173         .epp_write_addr = parport_ieee1284_epp_write_addr,
174         .epp_read_addr  = parport_ieee1284_epp_read_addr,
175
176         .ecp_write_data = parport_ieee1284_ecp_write_data,
177         .ecp_read_data  = parport_ieee1284_ecp_read_data,
178         .ecp_write_addr = parport_ieee1284_ecp_write_addr,
179
180         .compat_write_data      = parport_ieee1284_write_compat,
181         .nibble_read_data       = parport_ieee1284_read_nibble,
182         .byte_read_data         = parport_ieee1284_read_byte,
183
184         .owner          = THIS_MODULE,
185 };
186
187
188 static int __init parport_atari_init(void)
189 {
190         struct parport *p;
191         unsigned long flags;
192
193         if (MACH_IS_ATARI) {
194                 local_irq_save(flags);
195                 /* Soundchip port A/B as output. */
196                 sound_ym.rd_data_reg_sel = 7;
197                 sound_ym.wd_data = (sound_ym.rd_data_reg_sel & 0x3f) | 0xc0;
198                 /* STROBE high. */
199                 sound_ym.rd_data_reg_sel = 14;
200                 sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5);
201                 local_irq_restore(flags);
202                 /* MFP port I0 as input. */
203                 mfp.data_dir &= ~1;
204                 /* MFP port I0 interrupt on high->low edge. */
205                 mfp.active_edge &= ~1;
206                 p = parport_register_port((unsigned long)&sound_ym.wd_data,
207                                           IRQ_MFP_BUSY, PARPORT_DMA_NONE,
208                                           &parport_atari_ops);
209                 if (!p)
210                         return -ENODEV;
211                 if (request_irq(IRQ_MFP_BUSY, parport_atari_interrupt,
212                                 IRQ_TYPE_SLOW, p->name, p)) {
213                         parport_put_port (p);
214                         return -ENODEV;
215                 }
216
217                 this_port = p;
218                 printk(KERN_INFO "%s: Atari built-in port using irq\n", p->name);
219                 parport_announce_port (p);
220
221                 return 0;
222         }
223         return -ENODEV;
224 }
225
226 static void __exit parport_atari_exit(void)
227 {
228         parport_remove_port(this_port);
229         if (this_port->irq != PARPORT_IRQ_NONE)
230                 free_irq(IRQ_MFP_BUSY, this_port);
231         parport_put_port(this_port);
232 }
233
234 MODULE_AUTHOR("Andreas Schwab");
235 MODULE_DESCRIPTION("Parport Driver for Atari builtin Port");
236 MODULE_SUPPORTED_DEVICE("Atari builtin Parallel Port");
237 MODULE_LICENSE("GPL");
238
239 module_init(parport_atari_init)
240 module_exit(parport_atari_exit)