This source file includes following definitions.
- parport_atari_read_data
- parport_atari_write_data
- parport_atari_read_control
- parport_atari_write_control
- parport_atari_frob_control
- parport_atari_read_status
- parport_atari_init_state
- parport_atari_save_state
- parport_atari_restore_state
- parport_atari_enable_irq
- parport_atari_disable_irq
- parport_atari_data_forward
- parport_atari_data_reverse
- parport_atari_init
- parport_atari_exit
1
2
3
4
5
6
7
8
9
10
11
12
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/parport.h>
16 #include <linux/interrupt.h>
17 #include <asm/setup.h>
18 #include <asm/atarihw.h>
19 #include <asm/irq.h>
20 #include <asm/atariints.h>
21
22 static struct parport *this_port;
23
24 static unsigned char
25 parport_atari_read_data(struct parport *p)
26 {
27 unsigned long flags;
28 unsigned char data;
29
30 local_irq_save(flags);
31 sound_ym.rd_data_reg_sel = 15;
32 data = sound_ym.rd_data_reg_sel;
33 local_irq_restore(flags);
34 return data;
35 }
36
37 static void
38 parport_atari_write_data(struct parport *p, unsigned char data)
39 {
40 unsigned long flags;
41
42 local_irq_save(flags);
43 sound_ym.rd_data_reg_sel = 15;
44 sound_ym.wd_data = data;
45 local_irq_restore(flags);
46 }
47
48 static unsigned char
49 parport_atari_read_control(struct parport *p)
50 {
51 unsigned long flags;
52 unsigned char control = 0;
53
54 local_irq_save(flags);
55 sound_ym.rd_data_reg_sel = 14;
56 if (!(sound_ym.rd_data_reg_sel & (1 << 5)))
57 control = PARPORT_CONTROL_STROBE;
58 local_irq_restore(flags);
59 return control;
60 }
61
62 static void
63 parport_atari_write_control(struct parport *p, unsigned char control)
64 {
65 unsigned long flags;
66
67 local_irq_save(flags);
68 sound_ym.rd_data_reg_sel = 14;
69 if (control & PARPORT_CONTROL_STROBE)
70 sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~(1 << 5);
71 else
72 sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5);
73 local_irq_restore(flags);
74 }
75
76 static unsigned char
77 parport_atari_frob_control(struct parport *p, unsigned char mask,
78 unsigned char val)
79 {
80 unsigned char old = parport_atari_read_control(p);
81 parport_atari_write_control(p, (old & ~mask) ^ val);
82 return old;
83 }
84
85 static unsigned char
86 parport_atari_read_status(struct parport *p)
87 {
88 return ((st_mfp.par_dt_reg & 1 ? 0 : PARPORT_STATUS_BUSY) |
89 PARPORT_STATUS_SELECT | PARPORT_STATUS_ERROR);
90 }
91
92 static void
93 parport_atari_init_state(struct pardevice *d, struct parport_state *s)
94 {
95 }
96
97 static void
98 parport_atari_save_state(struct parport *p, struct parport_state *s)
99 {
100 }
101
102 static void
103 parport_atari_restore_state(struct parport *p, struct parport_state *s)
104 {
105 }
106
107 static void
108 parport_atari_enable_irq(struct parport *p)
109 {
110 enable_irq(IRQ_MFP_BUSY);
111 }
112
113 static void
114 parport_atari_disable_irq(struct parport *p)
115 {
116 disable_irq(IRQ_MFP_BUSY);
117 }
118
119 static void
120 parport_atari_data_forward(struct parport *p)
121 {
122 unsigned long flags;
123
124 local_irq_save(flags);
125
126 sound_ym.rd_data_reg_sel = 7;
127 sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x40;
128 local_irq_restore(flags);
129 }
130
131 static void
132 parport_atari_data_reverse(struct parport *p)
133 {
134 }
135
136 static struct parport_operations parport_atari_ops = {
137 .write_data = parport_atari_write_data,
138 .read_data = parport_atari_read_data,
139
140 .write_control = parport_atari_write_control,
141 .read_control = parport_atari_read_control,
142 .frob_control = parport_atari_frob_control,
143
144 .read_status = parport_atari_read_status,
145
146 .enable_irq = parport_atari_enable_irq,
147 .disable_irq = parport_atari_disable_irq,
148
149 .data_forward = parport_atari_data_forward,
150 .data_reverse = parport_atari_data_reverse,
151
152 .init_state = parport_atari_init_state,
153 .save_state = parport_atari_save_state,
154 .restore_state = parport_atari_restore_state,
155
156 .epp_write_data = parport_ieee1284_epp_write_data,
157 .epp_read_data = parport_ieee1284_epp_read_data,
158 .epp_write_addr = parport_ieee1284_epp_write_addr,
159 .epp_read_addr = parport_ieee1284_epp_read_addr,
160
161 .ecp_write_data = parport_ieee1284_ecp_write_data,
162 .ecp_read_data = parport_ieee1284_ecp_read_data,
163 .ecp_write_addr = parport_ieee1284_ecp_write_addr,
164
165 .compat_write_data = parport_ieee1284_write_compat,
166 .nibble_read_data = parport_ieee1284_read_nibble,
167 .byte_read_data = parport_ieee1284_read_byte,
168
169 .owner = THIS_MODULE,
170 };
171
172
173 static int __init parport_atari_init(void)
174 {
175 struct parport *p;
176 unsigned long flags;
177
178 if (MACH_IS_ATARI) {
179 local_irq_save(flags);
180
181 sound_ym.rd_data_reg_sel = 7;
182 sound_ym.wd_data = (sound_ym.rd_data_reg_sel & 0x3f) | 0xc0;
183
184 sound_ym.rd_data_reg_sel = 14;
185 sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5);
186 local_irq_restore(flags);
187
188 st_mfp.data_dir &= ~1;
189
190 st_mfp.active_edge &= ~1;
191 p = parport_register_port((unsigned long)&sound_ym.wd_data,
192 IRQ_MFP_BUSY, PARPORT_DMA_NONE,
193 &parport_atari_ops);
194 if (!p)
195 return -ENODEV;
196 if (request_irq(IRQ_MFP_BUSY, parport_irq_handler, 0, p->name,
197 p)) {
198 parport_put_port (p);
199 return -ENODEV;
200 }
201
202 this_port = p;
203 printk(KERN_INFO "%s: Atari built-in port using irq\n", p->name);
204 parport_announce_port (p);
205
206 return 0;
207 }
208 return -ENODEV;
209 }
210
211 static void __exit parport_atari_exit(void)
212 {
213 parport_remove_port(this_port);
214 if (this_port->irq != PARPORT_IRQ_NONE)
215 free_irq(IRQ_MFP_BUSY, this_port);
216 parport_put_port(this_port);
217 }
218
219 MODULE_AUTHOR("Andreas Schwab");
220 MODULE_DESCRIPTION("Parport Driver for Atari builtin Port");
221 MODULE_SUPPORTED_DEVICE("Atari builtin Parallel Port");
222 MODULE_LICENSE("GPL");
223
224 module_init(parport_atari_init)
225 module_exit(parport_atari_exit)