1/* Low-level parallel port routines for the Multiface 3 card
  2 *
  3 * Author: Joerg Dorchain <joerg@dorchain.net>
  4 *
  5 * (C) The elitist m68k Users(TM)
  6 *
  7 * based on the existing parport_amiga and lp_mfc
  8 *
  9 *
 10 * From the MFC3 documentation:
 11 * 
 12 * Miscellaneous PIA Details
 13 * -------------------------
 14 * 
 15 * 	The two open-drain interrupt outputs /IRQA and /IRQB are routed to
 16 * /INT2 of the Z2 bus.
 17 * 
 18 * 	The CPU data bus of the PIA (D0-D7) is connected to D8-D15 on the Z2
 19 * bus. This means that any PIA registers are accessed at even addresses.
 20 * 
 21 * Centronics Pin Connections for the PIA
 22 * --------------------------------------
 23 * 
 24 * 	The following table shows the connections between the PIA and the
 25 * Centronics interface connector. These connections implement a single, but
 26 * very complete, Centronics type interface. The Pin column gives the pin
 27 * numbers of the PIA. The Centronics pin numbers can be found in the section
 28 * "Parallel Connectors".
 29 * 
 30 * 
 31 *    Pin | PIA | Dir | Centronics Names
 32 * -------+-----+-----+---------------------------------------------------------
 33 *     19 | CB2 | --> | /STROBE (aka /DRDY)
 34 *  10-17 | PBx | <-> | DATA0 - DATA7
 35 *     18 | CB1 | <-- | /ACK
 36 *     40 | CA1 | <-- | BUSY
 37 *      3 | PA1 | <-- | PAPER-OUT (aka POUT)
 38 *      4 | PA2 | <-- | SELECTED (aka SEL)
 39 *      9 | PA7 | --> | /INIT (aka /RESET or /INPUT-PRIME)
 40 *      6 | PA4 | <-- | /ERROR (aka /FAULT)
 41 *      7 | PA5 | --> | DIR (aka /SELECT-IN)
 42 *      8 | PA6 | --> | /AUTO-FEED-XT
 43 *     39 | CA2 | --> | open
 44 *      5 | PA3 | <-- | /ACK (same as CB1!)
 45 *      2 | PA0 | <-- | BUSY (same as CA1!)
 46 * -------+-----+-----+---------------------------------------------------------
 47 * 
 48 * Should be enough to understand some of the driver.
 49 *
 50 * Per convention for normal use the port registers are visible.
 51 * If you need the data direction registers, restore the value in the
 52 * control register.
 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/* Maximum Number of Cards supported */
 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; /* for trigger readds */
 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; /* clears irq bit */
 89	/* Triggers also /STROBE.*/
 90	pia(p)->pprb = data;
 91}
 92
 93static unsigned char mfc3_read_data(struct parport *p)
 94{
 95	/* clears interrupt bit. Triggers also /STROBE. */
 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) /* XXX: What is SELECP? */
104		ret &= ~32; /* /SELECT_IN */
105	if (control & PARPORT_CONTROL_INIT) /* INITP */
106		ret |= 128;
107	if (control & PARPORT_CONTROL_AUTOFD) /* AUTOLF */
108		ret &= ~64;
109	if (control & PARPORT_CONTROL_STROBE) /* Strobe */
110		/* Handled directly by hardware */;
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) /* /INITP */
120		ret |= PARPORT_CONTROL_INIT;
121	if (control & 64) /* /AUTOLF */
122		ret &= ~PARPORT_CONTROL_AUTOFD;
123	if (control & 32) /* /SELECT_IN */
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
150#if 0 /* currently unused */
151static unsigned char status_pc_to_mfc3(unsigned char status)
152{
153	unsigned char ret = 1;
154
155	if (status & PARPORT_STATUS_BUSY) /* Busy */
156		ret &= ~1;
157	if (status & PARPORT_STATUS_ACK) /* Ack */
158		ret |= 8;
159	if (status & PARPORT_STATUS_PAPEROUT) /* PaperOut */
160		ret |= 2;
161	if (status & PARPORT_STATUS_SELECT) /* select */
162		ret |= 4;
163	if (status & PARPORT_STATUS_ERROR) /* error */
164		ret |= 16;
165	return ret;
166}
167#endif
168
169static unsigned char status_mfc3_to_pc(unsigned char status)
170{
171	unsigned char ret = PARPORT_STATUS_BUSY;
172
173	if (status & 1) /* Busy */
174		ret &= ~PARPORT_STATUS_BUSY;
175	if (status & 2) /* PaperOut */
176		ret |= PARPORT_STATUS_PAPEROUT;
177	if (status & 4) /* Selected */
178		ret |= PARPORT_STATUS_SELECT;
179	if (status & 8) /* Ack */
180		ret |= PARPORT_STATUS_ACK;
181	if (status & 16) /* /ERROR */
182		ret |= PARPORT_STATUS_ERROR;
183
184	return ret;
185}
186
187#if 0 /* currently unused */
188static void mfc3_write_status( struct parport *p, unsigned char status)
189{
190DPRINTK(KERN_DEBUG "write_status %02x\n",status);
191	pia(p)->ppra = (pia(p)->ppra & 0xe0) | status_pc_to_mfc3(status);
192}
193#endif
194
195static unsigned char mfc3_read_status(struct parport *p)
196{
197	unsigned char status;
198
199	status = status_mfc3_to_pc(pia(p)->ppra & 0x1f);
200DPRINTK(KERN_DEBUG "read_status %02x\n", status);
201	return status;
202}
203
204#if 0 /* currently unused */
205static void mfc3_change_mode( struct parport *p, int m)
206{
207	/* XXX: This port only has one mode, and I am
208	not sure about the corresponding PC-style mode*/
209}
210#endif
211
212static int use_cnt = 0;
213
214static irqreturn_t mfc3_interrupt(int irq, void *dev_id)
215{
216	int i;
217
218	for( i = 0; i < MAX_MFC; i++)
219		if (this_port[i] != NULL)
220			if (pia(this_port[i])->crb & 128) { /* Board caused interrupt */
221				dummy = pia(this_port[i])->pprb; /* clear irq bit */
222				parport_generic_irq(this_port[i]);
223			}
224	return IRQ_HANDLED;
225}
226
227static void mfc3_enable_irq(struct parport *p)
228{
229	pia(p)->crb |= PIA_C1_ENABLE_IRQ;
230}
231
232static void mfc3_disable_irq(struct parport *p)
233{
234	pia(p)->crb &= ~PIA_C1_ENABLE_IRQ;
235}
236
237static void mfc3_data_forward(struct parport *p)
238{
239	DPRINTK(KERN_DEBUG "forward\n");
240	pia(p)->crb &= ~PIA_DDR; /* make data direction register visible */
241	pia(p)->pddrb = 255; /* all pins output */
242	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
243}
244
245static void mfc3_data_reverse(struct parport *p)
246{
247	DPRINTK(KERN_DEBUG "reverse\n");
248	pia(p)->crb &= ~PIA_DDR; /* make data direction register visible */
249	pia(p)->pddrb = 0; /* all pins input */
250	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
251}
252
253static void mfc3_init_state(struct pardevice *dev, struct parport_state *s)
254{
255	s->u.amiga.data = 0;
256	s->u.amiga.datadir = 255;
257	s->u.amiga.status = 0;
258	s->u.amiga.statusdir = 0xe0;
259}
260
261static void mfc3_save_state(struct parport *p, struct parport_state *s)
262{
263	s->u.amiga.data = pia(p)->pprb;
264	pia(p)->crb &= ~PIA_DDR;
265	s->u.amiga.datadir = pia(p)->pddrb;
266	pia(p)->crb |= PIA_DDR;
267	s->u.amiga.status = pia(p)->ppra;
268	pia(p)->cra &= ~PIA_DDR;
269	s->u.amiga.statusdir = pia(p)->pddrb;
270	pia(p)->cra |= PIA_DDR;
271}
272
273static void mfc3_restore_state(struct parport *p, struct parport_state *s)
274{
275	pia(p)->pprb = s->u.amiga.data;
276	pia(p)->crb &= ~PIA_DDR;
277	pia(p)->pddrb = s->u.amiga.datadir;
278	pia(p)->crb |= PIA_DDR;
279	pia(p)->ppra = s->u.amiga.status;
280	pia(p)->cra &= ~PIA_DDR;
281	pia(p)->pddrb = s->u.amiga.statusdir;
282	pia(p)->cra |= PIA_DDR;
283}
284
285static struct parport_operations pp_mfc3_ops = {
286	.write_data	= mfc3_write_data,
287	.read_data	= mfc3_read_data,
288
289	.write_control	= mfc3_write_control,
290	.read_control	= mfc3_read_control,
291	.frob_control	= mfc3_frob_control,
292
293	.read_status	= mfc3_read_status,
294
295	.enable_irq	= mfc3_enable_irq,
296	.disable_irq	= mfc3_disable_irq,
297
298	.data_forward	= mfc3_data_forward, 
299	.data_reverse	= mfc3_data_reverse, 
300
301	.init_state	= mfc3_init_state,
302	.save_state	= mfc3_save_state,
303	.restore_state	= mfc3_restore_state,
304
305	.epp_write_data	= parport_ieee1284_epp_write_data,
306	.epp_read_data	= parport_ieee1284_epp_read_data,
307	.epp_write_addr	= parport_ieee1284_epp_write_addr,
308	.epp_read_addr	= parport_ieee1284_epp_read_addr,
309
310	.ecp_write_data	= parport_ieee1284_ecp_write_data,
311	.ecp_read_data	= parport_ieee1284_ecp_read_data,
312	.ecp_write_addr	= parport_ieee1284_ecp_write_addr,
313
314	.compat_write_data	= parport_ieee1284_write_compat,
315	.nibble_read_data	= parport_ieee1284_read_nibble,
316	.byte_read_data		= parport_ieee1284_read_byte,
317
318	.owner		= THIS_MODULE,
319};
320
321/* ----------- Initialisation code --------------------------------- */
322
323static int __init parport_mfc3_init(void)
324{
325	struct parport *p;
326	int pias = 0;
327	struct pia *pp;
328	struct zorro_dev *z = NULL;
329
330	if (!MACH_IS_AMIGA)
331		return -ENODEV;
332
333	while ((z = zorro_find_device(ZORRO_PROD_BSC_MULTIFACE_III, z))) {
334		unsigned long piabase = z->resource.start+PIABASE;
335		if (!request_mem_region(piabase, sizeof(struct pia), "PIA"))
336			continue;
337
338		pp = (struct pia *)ZTWO_VADDR(piabase);
339		pp->crb = 0;
340		pp->pddrb = 255; /* all data pins output */
341		pp->crb = PIA_DDR|32|8;
342		dummy = pp->pddrb; /* reading clears interrupt */
343		pp->cra = 0;
344		pp->pddra = 0xe0; /* /RESET,  /DIR ,/AUTO-FEED output */
345		pp->cra = PIA_DDR;
346		pp->ppra = 0; /* reset printer */
347		udelay(10);
348		pp->ppra = 128;
349		p = parport_register_port((unsigned long)pp, IRQ_AMIGA_PORTS,
350					  PARPORT_DMA_NONE, &pp_mfc3_ops);
351		if (!p)
352			goto out_port;
353
354		if (p->irq != PARPORT_IRQ_NONE) {
355			if (use_cnt++ == 0)
356				if (request_irq(IRQ_AMIGA_PORTS, mfc3_interrupt, IRQF_SHARED, p->name, &pp_mfc3_ops))
357					goto out_irq;
358		}
359		p->dev = &z->dev;
360
361		this_port[pias++] = p;
362		printk(KERN_INFO "%s: Multiface III port using irq\n", p->name);
363		/* XXX: set operating mode */
364
365		p->private_data = (void *)piabase;
366		parport_announce_port (p);
367
368		if (pias >= MAX_MFC)
369			break;
370		continue;
371
372	out_irq:
373		parport_put_port(p);
374	out_port:
375		release_mem_region(piabase, sizeof(struct pia));
376	}
377
378	return pias ? 0 : -ENODEV;
379}
380
381static void __exit parport_mfc3_exit(void)
382{
383	int i;
384
385	for (i = 0; i < MAX_MFC; i++) {
386		if (!this_port[i])
387			continue;
388		parport_remove_port(this_port[i]);
389		if (this_port[i]->irq != PARPORT_IRQ_NONE) {
390			if (--use_cnt == 0) 
391				free_irq(IRQ_AMIGA_PORTS, &pp_mfc3_ops);
392		}
393		release_mem_region(ZTWO_PADDR(this_port[i]->private_data), sizeof(struct pia));
394		parport_put_port(this_port[i]);
395	}
396}
397
398
399MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
400MODULE_DESCRIPTION("Parport Driver for Multiface 3 expansion cards Paralllel Port");
401MODULE_SUPPORTED_DEVICE("Multiface 3 Parallel Port");
402MODULE_LICENSE("GPL");
403
404module_init(parport_mfc3_init)
405module_exit(parport_mfc3_exit)

  1/* Low-level parallel port routines for the Multiface 3 card
  2 *
  3 * Author: Joerg Dorchain <joerg@dorchain.net>
  4 *
  5 * (C) The elitist m68k Users(TM)
  6 *
  7 * based on the existing parport_amiga and lp_mfc
  8 *
  9 *
 10 * From the MFC3 documentation:
 11 * 
 12 * Miscellaneous PIA Details
 13 * -------------------------
 14 * 
 15 * 	The two open-drain interrupt outputs /IRQA and /IRQB are routed to
 16 * /INT2 of the Z2 bus.
 17 * 
 18 * 	The CPU data bus of the PIA (D0-D7) is connected to D8-D15 on the Z2
 19 * bus. This means that any PIA registers are accessed at even addresses.
 20 * 
 21 * Centronics Pin Connections for the PIA
 22 * --------------------------------------
 23 * 
 24 * 	The following table shows the connections between the PIA and the
 25 * Centronics interface connector. These connections implement a single, but
 26 * very complete, Centronics type interface. The Pin column gives the pin
 27 * numbers of the PIA. The Centronics pin numbers can be found in the section
 28 * "Parallel Connectors".
 29 * 
 30 * 
 31 *    Pin | PIA | Dir | Centronics Names
 32 * -------+-----+-----+---------------------------------------------------------
 33 *     19 | CB2 | --> | /STROBE (aka /DRDY)
 34 *  10-17 | PBx | <-> | DATA0 - DATA7
 35 *     18 | CB1 | <-- | /ACK
 36 *     40 | CA1 | <-- | BUSY
 37 *      3 | PA1 | <-- | PAPER-OUT (aka POUT)
 38 *      4 | PA2 | <-- | SELECTED (aka SEL)
 39 *      9 | PA7 | --> | /INIT (aka /RESET or /INPUT-PRIME)
 40 *      6 | PA4 | <-- | /ERROR (aka /FAULT)
 41 *      7 | PA5 | --> | DIR (aka /SELECT-IN)
 42 *      8 | PA6 | --> | /AUTO-FEED-XT
 43 *     39 | CA2 | --> | open
 44 *      5 | PA3 | <-- | /ACK (same as CB1!)
 45 *      2 | PA0 | <-- | BUSY (same as CA1!)
 46 * -------+-----+-----+---------------------------------------------------------
 47 * 
 48 * Should be enough to understand some of the driver.
 49 *
 50 * Per convention for normal use the port registers are visible.
 51 * If you need the data direction registers, restore the value in the
 52 * control register.
 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/* Maximum Number of Cards supported */
 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; /* for trigger readds */
 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; /* clears irq bit */
 89	/* Triggers also /STROBE.*/
 90	pia(p)->pprb = data;
 91}
 92
 93static unsigned char mfc3_read_data(struct parport *p)
 94{
 95	/* clears interrupt bit. Triggers also /STROBE. */
 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) /* XXX: What is SELECP? */
104		ret &= ~32; /* /SELECT_IN */
105	if (control & PARPORT_CONTROL_INIT) /* INITP */
106		ret |= 128;
107	if (control & PARPORT_CONTROL_AUTOFD) /* AUTOLF */
108		ret &= ~64;
109	if (control & PARPORT_CONTROL_STROBE) /* Strobe */
110		/* Handled directly by hardware */;
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) /* /INITP */
120		ret |= PARPORT_CONTROL_INIT;
121	if (control & 64) /* /AUTOLF */
122		ret &= ~PARPORT_CONTROL_AUTOFD;
123	if (control & 32) /* /SELECT_IN */
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) /* Busy */
155		ret &= ~PARPORT_STATUS_BUSY;
156	if (status & 2) /* PaperOut */
157		ret |= PARPORT_STATUS_PAPEROUT;
158	if (status & 4) /* Selected */
159		ret |= PARPORT_STATUS_SELECT;
160	if (status & 8) /* Ack */
161		ret |= PARPORT_STATUS_ACK;
162	if (status & 16) /* /ERROR */
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) { /* Board caused interrupt */
186				dummy = pia(this_port[i])->pprb; /* clear irq bit */
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; /* make data direction register visible */
206	pia(p)->pddrb = 255; /* all pins output */
207	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
208}
209
210static void mfc3_data_reverse(struct parport *p)
211{
212	DPRINTK(KERN_DEBUG "reverse\n");
213	pia(p)->crb &= ~PIA_DDR; /* make data direction register visible */
214	pia(p)->pddrb = 0; /* all pins input */
215	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
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/* ----------- Initialisation code --------------------------------- */
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 = ZTWO_VADDR(piabase);
304		pp->crb = 0;
305		pp->pddrb = 255; /* all data pins output */
306		pp->crb = PIA_DDR|32|8;
307		dummy = pp->pddrb; /* reading clears interrupt */
308		pp->cra = 0;
309		pp->pddra = 0xe0; /* /RESET,  /DIR ,/AUTO-FEED output */
310		pp->cra = PIA_DDR;
311		pp->ppra = 0; /* reset printer */
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		/* XXX: set operating mode */
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)