1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55#include "multiface.h"
56#include <linux/module.h>
57#include <linux/init.h>
58#include <linux/parport.h>
59#include <linux/delay.h>
60#include <linux/mc6821.h>
61#include <linux/zorro.h>
62#include <linux/interrupt.h>
63#include <asm/setup.h>
64#include <asm/amigahw.h>
65#include <asm/irq.h>
66#include <asm/amigaints.h>
67
68
69#define MAX_MFC 5
70
71#undef DEBUG
72#ifdef DEBUG
73#define DPRINTK printk
74#else
75static inline int DPRINTK(void *nothing, ...) {return 0;}
76#endif
77
78static struct parport *this_port[MAX_MFC] = {NULL, };
79static volatile int dummy;
80
81#define pia(dev) ((struct pia *)(dev->base))
82static struct parport_operations pp_mfc3_ops;
83
84static void mfc3_write_data(struct parport *p, unsigned char data)
85{
86DPRINTK(KERN_DEBUG "write_data %c\n",data);
87
88 dummy = pia(p)->pprb;
89
90 pia(p)->pprb = data;
91}
92
93static unsigned char mfc3_read_data(struct parport *p)
94{
95
96 return pia(p)->pprb;
97}
98
99static unsigned char control_pc_to_mfc3(unsigned char control)
100{
101 unsigned char ret = 32|64;
102
103 if (control & PARPORT_CONTROL_SELECT)
104 ret &= ~32;
105 if (control & PARPORT_CONTROL_INIT)
106 ret |= 128;
107 if (control & PARPORT_CONTROL_AUTOFD)
108 ret &= ~64;
109 if (control & PARPORT_CONTROL_STROBE)
110 ;
111 return ret;
112}
113
114static unsigned char control_mfc3_to_pc(unsigned char control)
115{
116 unsigned char ret = PARPORT_CONTROL_STROBE
117 | PARPORT_CONTROL_AUTOFD | PARPORT_CONTROL_SELECT;
118
119 if (control & 128)
120 ret |= PARPORT_CONTROL_INIT;
121 if (control & 64)
122 ret &= ~PARPORT_CONTROL_AUTOFD;
123 if (control & 32)
124 ret &= ~PARPORT_CONTROL_SELECT;
125 return ret;
126}
127
128static void mfc3_write_control(struct parport *p, unsigned char control)
129{
130DPRINTK(KERN_DEBUG "write_control %02x\n",control);
131 pia(p)->ppra = (pia(p)->ppra & 0x1f) | control_pc_to_mfc3(control);
132}
133
134static unsigned char mfc3_read_control( struct parport *p)
135{
136DPRINTK(KERN_DEBUG "read_control \n");
137 return control_mfc3_to_pc(pia(p)->ppra & 0xe0);
138}
139
140static unsigned char mfc3_frob_control( struct parport *p, unsigned char mask, unsigned char val)
141{
142 unsigned char old;
143
144DPRINTK(KERN_DEBUG "frob_control mask %02x, value %02x\n",mask,val);
145 old = mfc3_read_control(p);
146 mfc3_write_control(p, (old & ~mask) ^ val);
147 return old;
148}
149
150static unsigned char status_mfc3_to_pc(unsigned char status)
151{
152 unsigned char ret = PARPORT_STATUS_BUSY;
153
154 if (status & 1)
155 ret &= ~PARPORT_STATUS_BUSY;
156 if (status & 2)
157 ret |= PARPORT_STATUS_PAPEROUT;
158 if (status & 4)
159 ret |= PARPORT_STATUS_SELECT;
160 if (status & 8)
161 ret |= PARPORT_STATUS_ACK;
162 if (status & 16)
163 ret |= PARPORT_STATUS_ERROR;
164
165 return ret;
166}
167
168static unsigned char mfc3_read_status(struct parport *p)
169{
170 unsigned char status;
171
172 status = status_mfc3_to_pc(pia(p)->ppra & 0x1f);
173DPRINTK(KERN_DEBUG "read_status %02x\n", status);
174 return status;
175}
176
177static int use_cnt = 0;
178
179static irqreturn_t mfc3_interrupt(int irq, void *dev_id)
180{
181 int i;
182
183 for( i = 0; i < MAX_MFC; i++)
184 if (this_port[i] != NULL)
185 if (pia(this_port[i])->crb & 128) {
186 dummy = pia(this_port[i])->pprb;
187 parport_generic_irq(this_port[i]);
188 }
189 return IRQ_HANDLED;
190}
191
192static void mfc3_enable_irq(struct parport *p)
193{
194 pia(p)->crb |= PIA_C1_ENABLE_IRQ;
195}
196
197static void mfc3_disable_irq(struct parport *p)
198{
199 pia(p)->crb &= ~PIA_C1_ENABLE_IRQ;
200}
201
202static void mfc3_data_forward(struct parport *p)
203{
204 DPRINTK(KERN_DEBUG "forward\n");
205 pia(p)->crb &= ~PIA_DDR;
206 pia(p)->pddrb = 255;
207 pia(p)->crb |= PIA_DDR;
208}
209
210static void mfc3_data_reverse(struct parport *p)
211{
212 DPRINTK(KERN_DEBUG "reverse\n");
213 pia(p)->crb &= ~PIA_DDR;
214 pia(p)->pddrb = 0;
215 pia(p)->crb |= PIA_DDR;
216}
217
218static void mfc3_init_state(struct pardevice *dev, struct parport_state *s)
219{
220 s->u.amiga.data = 0;
221 s->u.amiga.datadir = 255;
222 s->u.amiga.status = 0;
223 s->u.amiga.statusdir = 0xe0;
224}
225
226static void mfc3_save_state(struct parport *p, struct parport_state *s)
227{
228 s->u.amiga.data = pia(p)->pprb;
229 pia(p)->crb &= ~PIA_DDR;
230 s->u.amiga.datadir = pia(p)->pddrb;
231 pia(p)->crb |= PIA_DDR;
232 s->u.amiga.status = pia(p)->ppra;
233 pia(p)->cra &= ~PIA_DDR;
234 s->u.amiga.statusdir = pia(p)->pddrb;
235 pia(p)->cra |= PIA_DDR;
236}
237
238static void mfc3_restore_state(struct parport *p, struct parport_state *s)
239{
240 pia(p)->pprb = s->u.amiga.data;
241 pia(p)->crb &= ~PIA_DDR;
242 pia(p)->pddrb = s->u.amiga.datadir;
243 pia(p)->crb |= PIA_DDR;
244 pia(p)->ppra = s->u.amiga.status;
245 pia(p)->cra &= ~PIA_DDR;
246 pia(p)->pddrb = s->u.amiga.statusdir;
247 pia(p)->cra |= PIA_DDR;
248}
249
250static struct parport_operations pp_mfc3_ops = {
251 .write_data = mfc3_write_data,
252 .read_data = mfc3_read_data,
253
254 .write_control = mfc3_write_control,
255 .read_control = mfc3_read_control,
256 .frob_control = mfc3_frob_control,
257
258 .read_status = mfc3_read_status,
259
260 .enable_irq = mfc3_enable_irq,
261 .disable_irq = mfc3_disable_irq,
262
263 .data_forward = mfc3_data_forward,
264 .data_reverse = mfc3_data_reverse,
265
266 .init_state = mfc3_init_state,
267 .save_state = mfc3_save_state,
268 .restore_state = mfc3_restore_state,
269
270 .epp_write_data = parport_ieee1284_epp_write_data,
271 .epp_read_data = parport_ieee1284_epp_read_data,
272 .epp_write_addr = parport_ieee1284_epp_write_addr,
273 .epp_read_addr = parport_ieee1284_epp_read_addr,
274
275 .ecp_write_data = parport_ieee1284_ecp_write_data,
276 .ecp_read_data = parport_ieee1284_ecp_read_data,
277 .ecp_write_addr = parport_ieee1284_ecp_write_addr,
278
279 .compat_write_data = parport_ieee1284_write_compat,
280 .nibble_read_data = parport_ieee1284_read_nibble,
281 .byte_read_data = parport_ieee1284_read_byte,
282
283 .owner = THIS_MODULE,
284};
285
286
287
288static int __init parport_mfc3_init(void)
289{
290 struct parport *p;
291 int pias = 0;
292 struct pia *pp;
293 struct zorro_dev *z = NULL;
294
295 if (!MACH_IS_AMIGA)
296 return -ENODEV;
297
298 while ((z = zorro_find_device(ZORRO_PROD_BSC_MULTIFACE_III, z))) {
299 unsigned long piabase = z->resource.start+PIABASE;
300 if (!request_mem_region(piabase, sizeof(struct pia), "PIA"))
301 continue;
302
303 pp = (struct pia *)ZTWO_VADDR(piabase);
304 pp->crb = 0;
305 pp->pddrb = 255;
306 pp->crb = PIA_DDR|32|8;
307 dummy = pp->pddrb;
308 pp->cra = 0;
309 pp->pddra = 0xe0;
310 pp->cra = PIA_DDR;
311 pp->ppra = 0;
312 udelay(10);
313 pp->ppra = 128;
314 p = parport_register_port((unsigned long)pp, IRQ_AMIGA_PORTS,
315 PARPORT_DMA_NONE, &pp_mfc3_ops);
316 if (!p)
317 goto out_port;
318
319 if (p->irq != PARPORT_IRQ_NONE) {
320 if (use_cnt++ == 0)
321 if (request_irq(IRQ_AMIGA_PORTS, mfc3_interrupt, IRQF_SHARED, p->name, &pp_mfc3_ops))
322 goto out_irq;
323 }
324 p->dev = &z->dev;
325
326 this_port[pias++] = p;
327 printk(KERN_INFO "%s: Multiface III port using irq\n", p->name);
328
329
330 p->private_data = (void *)piabase;
331 parport_announce_port (p);
332
333 if (pias >= MAX_MFC)
334 break;
335 continue;
336
337 out_irq:
338 parport_put_port(p);
339 out_port:
340 release_mem_region(piabase, sizeof(struct pia));
341 }
342
343 return pias ? 0 : -ENODEV;
344}
345
346static void __exit parport_mfc3_exit(void)
347{
348 int i;
349
350 for (i = 0; i < MAX_MFC; i++) {
351 if (!this_port[i])
352 continue;
353 parport_remove_port(this_port[i]);
354 if (this_port[i]->irq != PARPORT_IRQ_NONE) {
355 if (--use_cnt == 0)
356 free_irq(IRQ_AMIGA_PORTS, &pp_mfc3_ops);
357 }
358 release_mem_region(ZTWO_PADDR(this_port[i]->private_data), sizeof(struct pia));
359 parport_put_port(this_port[i]);
360 }
361}
362
363
364MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
365MODULE_DESCRIPTION("Parport Driver for Multiface 3 expansion cards Parallel Port");
366MODULE_SUPPORTED_DEVICE("Multiface 3 Parallel Port");
367MODULE_LICENSE("GPL");
368
369module_init(parport_mfc3_init)
370module_exit(parport_mfc3_exit)
371