[net-next-2.6.git] / drivers / parport / parport_mfc3.c

/* Low-level parallel port routines for the Multiface 3 card
 *
 * Author: Joerg Dorchain <joerg@dorchain.net>
 *
 * (C) The elitist m68k Users(TM)
 *
 * based on the existing parport_amiga and lp_mfc
 *
 *
 * From the MFC3 documentation:
 * 
 * Miscellaneous PIA Details
 * -------------------------
 * 
 * 	The two open-drain interrupt outputs /IRQA and /IRQB are routed to
 * /INT2 of the Z2 bus.
 * 
 * 	The CPU data bus of the PIA (D0-D7) is connected to D8-D15 on the Z2
 * bus. This means that any PIA registers are accessed at even addresses.
 * 
 * Centronics Pin Connections for the PIA
 * --------------------------------------
 * 
 * 	The following table shows the connections between the PIA and the
 * Centronics interface connector. These connections implement a single, but
 * very complete, Centronics type interface. The Pin column gives the pin
 * numbers of the PIA. The Centronics pin numbers can be found in the section
 * "Parallel Connectors".
 * 
 * 
 *    Pin | PIA | Dir | Centronics Names
 * -------+-----+-----+---------------------------------------------------------
 *     19 | CB2 | --> | /STROBE (aka /DRDY)
 *  10-17 | PBx | <-> | DATA0 - DATA7
 *     18 | CB1 | <-- | /ACK
 *     40 | CA1 | <-- | BUSY
 *      3 | PA1 | <-- | PAPER-OUT (aka POUT)
 *      4 | PA2 | <-- | SELECTED (aka SEL)
 *      9 | PA7 | --> | /INIT (aka /RESET or /INPUT-PRIME)
 *      6 | PA4 | <-- | /ERROR (aka /FAULT)
 *      7 | PA5 | --> | DIR (aka /SELECT-IN)
 *      8 | PA6 | --> | /AUTO-FEED-XT
 *     39 | CA2 | --> | open
 *      5 | PA3 | <-- | /ACK (same as CB1!)
 *      2 | PA0 | <-- | BUSY (same as CA1!)
 * -------+-----+-----+---------------------------------------------------------
 * 
 * Should be enough to understand some of the driver.
 *
 * Per convention for normal use the port registers are visible.
 * If you need the data direction registers, restore the value in the
 * control register.
 */

#include "multiface.h"
#include <linux/module.h>
#include <linux/init.h>
#include <linux/parport.h>
#include <linux/delay.h>
#include <linux/mc6821.h>
#include <linux/zorro.h>
#include <linux/interrupt.h>
#include <asm/setup.h>
#include <asm/amigahw.h>
#include <asm/irq.h>
#include <asm/amigaints.h>

/* Maximum Number of Cards supported */
#define MAX_MFC 5

#undef DEBUG
#ifdef DEBUG
#define DPRINTK printk
#else
static inline int DPRINTK(void *nothing, ...) {return 0;}
#endif

static struct parport *this_port[MAX_MFC] = {NULL, };
static volatile int dummy; /* for trigger readds */

#define pia(dev) ((struct pia *)(dev->base))
static struct parport_operations pp_mfc3_ops;

static void mfc3_write_data(struct parport *p, unsigned char data)
{
DPRINTK(KERN_DEBUG "write_data %c\n",data);

	dummy = pia(p)->pprb; /* clears irq bit */
	/* Triggers also /STROBE.*/
	pia(p)->pprb = data;
}

static unsigned char mfc3_read_data(struct parport *p)
{
	/* clears interrupt bit. Triggers also /STROBE. */
	return pia(p)->pprb;
}

static unsigned char control_pc_to_mfc3(unsigned char control)
{
	unsigned char ret = 32|64;

	if (control & PARPORT_CONTROL_SELECT) /* XXX: What is SELECP? */
		ret &= ~32; /* /SELECT_IN */
	if (control & PARPORT_CONTROL_INIT) /* INITP */
		ret |= 128;
	if (control & PARPORT_CONTROL_AUTOFD) /* AUTOLF */
		ret &= ~64;
	if (control & PARPORT_CONTROL_STROBE) /* Strobe */
		/* Handled directly by hardware */;
	return ret;
}

static unsigned char control_mfc3_to_pc(unsigned char control)
{
	unsigned char ret = PARPORT_CONTROL_STROBE 
			  | PARPORT_CONTROL_AUTOFD | PARPORT_CONTROL_SELECT;

	if (control & 128) /* /INITP */
		ret |= PARPORT_CONTROL_INIT;
	if (control & 64) /* /AUTOLF */
		ret &= ~PARPORT_CONTROL_AUTOFD;
	if (control & 32) /* /SELECT_IN */
		ret &= ~PARPORT_CONTROL_SELECT;
	return ret;
}

static void mfc3_write_control(struct parport *p, unsigned char control)
{
DPRINTK(KERN_DEBUG "write_control %02x\n",control);
	pia(p)->ppra = (pia(p)->ppra & 0x1f) | control_pc_to_mfc3(control);
}
	
static unsigned char mfc3_read_control( struct parport *p)
{
DPRINTK(KERN_DEBUG "read_control \n");
	return control_mfc3_to_pc(pia(p)->ppra & 0xe0);
}

static unsigned char mfc3_frob_control( struct parport *p, unsigned char mask, unsigned char val)
{
	unsigned char old;

DPRINTK(KERN_DEBUG "frob_control mask %02x, value %02x\n",mask,val);
	old = mfc3_read_control(p);
	mfc3_write_control(p, (old & ~mask) ^ val);
	return old;
}

#if 0 /* currently unused */
static unsigned char status_pc_to_mfc3(unsigned char status)
{
	unsigned char ret = 1;

	if (status & PARPORT_STATUS_BUSY) /* Busy */
		ret &= ~1;
	if (status & PARPORT_STATUS_ACK) /* Ack */
		ret |= 8;
	if (status & PARPORT_STATUS_PAPEROUT) /* PaperOut */
		ret |= 2;
	if (status & PARPORT_STATUS_SELECT) /* select */
		ret |= 4;
	if (status & PARPORT_STATUS_ERROR) /* error */
		ret |= 16;
	return ret;
}
#endif

static unsigned char status_mfc3_to_pc(unsigned char status)
{
	unsigned char ret = PARPORT_STATUS_BUSY;

	if (status & 1) /* Busy */
		ret &= ~PARPORT_STATUS_BUSY;
	if (status & 2) /* PaperOut */
		ret |= PARPORT_STATUS_PAPEROUT;
	if (status & 4) /* Selected */
		ret |= PARPORT_STATUS_SELECT;
	if (status & 8) /* Ack */
		ret |= PARPORT_STATUS_ACK;
	if (status & 16) /* /ERROR */
		ret |= PARPORT_STATUS_ERROR;

	return ret;
}

#if 0 /* currently unused */
static void mfc3_write_status( struct parport *p, unsigned char status)
{
DPRINTK(KERN_DEBUG "write_status %02x\n",status);
	pia(p)->ppra = (pia(p)->ppra & 0xe0) | status_pc_to_mfc3(status);
}
#endif

static unsigned char mfc3_read_status(struct parport *p)
{
	unsigned char status;

	status = status_mfc3_to_pc(pia(p)->ppra & 0x1f);
DPRINTK(KERN_DEBUG "read_status %02x\n", status);
	return status;
}

#if 0 /* currently unused */
static void mfc3_change_mode( struct parport *p, int m)
{
	/* XXX: This port only has one mode, and I am
	not sure about the corresponding PC-style mode*/
}
#endif

static int use_cnt = 0;

static irqreturn_t mfc3_interrupt(int irq, void *dev_id)
{
	int i;

	for( i = 0; i < MAX_MFC; i++)
		if (this_port[i] != NULL)
			if (pia(this_port[i])->crb & 128) { /* Board caused interrupt */
				dummy = pia(this_port[i])->pprb; /* clear irq bit */
				parport_generic_irq(this_port[i]);
			}
	return IRQ_HANDLED;
}

static void mfc3_enable_irq(struct parport *p)
{
	pia(p)->crb |= PIA_C1_ENABLE_IRQ;
}

static void mfc3_disable_irq(struct parport *p)
{
	pia(p)->crb &= ~PIA_C1_ENABLE_IRQ;
}

static void mfc3_data_forward(struct parport *p)
{
	DPRINTK(KERN_DEBUG "forward\n");
	pia(p)->crb &= ~PIA_DDR; /* make data direction register visible */
	pia(p)->pddrb = 255; /* all pins output */
	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
}

static void mfc3_data_reverse(struct parport *p)
{
	DPRINTK(KERN_DEBUG "reverse\n");
	pia(p)->crb &= ~PIA_DDR; /* make data direction register visible */
	pia(p)->pddrb = 0; /* all pins input */
	pia(p)->crb |= PIA_DDR; /* make data register visible - default */
}

static void mfc3_init_state(struct pardevice *dev, struct parport_state *s)
{
	s->u.amiga.data = 0;
	s->u.amiga.datadir = 255;
	s->u.amiga.status = 0;
	s->u.amiga.statusdir = 0xe0;
}

static void mfc3_save_state(struct parport *p, struct parport_state *s)
{
	s->u.amiga.data = pia(p)->pprb;
	pia(p)->crb &= ~PIA_DDR;
	s->u.amiga.datadir = pia(p)->pddrb;
	pia(p)->crb |= PIA_DDR;
	s->u.amiga.status = pia(p)->ppra;
	pia(p)->cra &= ~PIA_DDR;
	s->u.amiga.statusdir = pia(p)->pddrb;
	pia(p)->cra |= PIA_DDR;
}

static void mfc3_restore_state(struct parport *p, struct parport_state *s)
{
	pia(p)->pprb = s->u.amiga.data;
	pia(p)->crb &= ~PIA_DDR;
	pia(p)->pddrb = s->u.amiga.datadir;
	pia(p)->crb |= PIA_DDR;
	pia(p)->ppra = s->u.amiga.status;
	pia(p)->cra &= ~PIA_DDR;
	pia(p)->pddrb = s->u.amiga.statusdir;
	pia(p)->cra |= PIA_DDR;
}

static struct parport_operations pp_mfc3_ops = {
	.write_data	= mfc3_write_data,
	.read_data	= mfc3_read_data,

	.write_control	= mfc3_write_control,
	.read_control	= mfc3_read_control,
	.frob_control	= mfc3_frob_control,

	.read_status	= mfc3_read_status,

	.enable_irq	= mfc3_enable_irq,
	.disable_irq	= mfc3_disable_irq,

	.data_forward	= mfc3_data_forward, 
	.data_reverse	= mfc3_data_reverse, 

	.init_state	= mfc3_init_state,
	.save_state	= mfc3_save_state,
	.restore_state	= mfc3_restore_state,

	.epp_write_data	= parport_ieee1284_epp_write_data,
	.epp_read_data	= parport_ieee1284_epp_read_data,
	.epp_write_addr	= parport_ieee1284_epp_write_addr,
	.epp_read_addr	= parport_ieee1284_epp_read_addr,

	.ecp_write_data	= parport_ieee1284_ecp_write_data,
	.ecp_read_data	= parport_ieee1284_ecp_read_data,
	.ecp_write_addr	= parport_ieee1284_ecp_write_addr,

	.compat_write_data	= parport_ieee1284_write_compat,
	.nibble_read_data	= parport_ieee1284_read_nibble,
	.byte_read_data		= parport_ieee1284_read_byte,

	.owner		= THIS_MODULE,
};

/* ----------- Initialisation code --------------------------------- */

static int __init parport_mfc3_init(void)
{
	struct parport *p;
	int pias = 0;
	struct pia *pp;
	struct zorro_dev *z = NULL;

	if (!MACH_IS_AMIGA)
		return -ENODEV;

	while ((z = zorro_find_device(ZORRO_PROD_BSC_MULTIFACE_III, z))) {
		unsigned long piabase = z->resource.start+PIABASE;
		if (!request_mem_region(piabase, sizeof(struct pia), "PIA"))
			continue;

		pp = (struct pia *)ZTWO_VADDR(piabase);
		pp->crb = 0;
		pp->pddrb = 255; /* all data pins output */
		pp->crb = PIA_DDR|32|8;
		dummy = pp->pddrb; /* reading clears interrupt */
		pp->cra = 0;
		pp->pddra = 0xe0; /* /RESET,  /DIR ,/AUTO-FEED output */
		pp->cra = PIA_DDR;
		pp->ppra = 0; /* reset printer */
		udelay(10);
		pp->ppra = 128;
		p = parport_register_port((unsigned long)pp, IRQ_AMIGA_PORTS,
					  PARPORT_DMA_NONE, &pp_mfc3_ops);
		if (!p)
			goto out_port;

		if (p->irq != PARPORT_IRQ_NONE) {
			if (use_cnt++ == 0)
				if (request_irq(IRQ_AMIGA_PORTS, mfc3_interrupt, IRQF_SHARED, p->name, &pp_mfc3_ops))
					goto out_irq;
		}
		p->dev = &z->dev;

		this_port[pias++] = p;
		printk(KERN_INFO "%s: Multiface III port using irq\n", p->name);
		/* XXX: set operating mode */

		p->private_data = (void *)piabase;
		parport_announce_port (p);

		if (pias >= MAX_MFC)
			break;
		continue;

	out_irq:
		parport_put_port(p);
	out_port:
		release_mem_region(piabase, sizeof(struct pia));
	}

	return pias ? 0 : -ENODEV;
}

static void __exit parport_mfc3_exit(void)
{
	int i;

	for (i = 0; i < MAX_MFC; i++) {
		if (!this_port[i])
			continue;
		parport_remove_port(this_port[i]);
		if (this_port[i]->irq != PARPORT_IRQ_NONE) {
			if (--use_cnt == 0) 
				free_irq(IRQ_AMIGA_PORTS, &pp_mfc3_ops);
		}
		release_mem_region(ZTWO_PADDR(this_port[i]->private_data), sizeof(struct pia));
		parport_put_port(this_port[i]);
	}
}


MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
MODULE_DESCRIPTION("Parport Driver for Multiface 3 expansion cards Paralllel Port");
MODULE_SUPPORTED_DEVICE("Multiface 3 Parallel Port");
MODULE_LICENSE("GPL");

module_init(parport_mfc3_init)
module_exit(parport_mfc3_exit)
Commit	Line	Data
1da177e4 LT	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
75	static inline int DPRINTK(void *nothing, ...) {return 0;}
76	#endif
77
78	static struct parport *this_port[MAX_MFC] = {NULL, };
79	static volatile int dummy; /* for trigger readds */
80
81	#define pia(dev) ((struct pia *)(dev->base))
82	static struct parport_operations pp_mfc3_ops;
83
84	static void mfc3_write_data(struct parport *p, unsigned char data)
85	{
86	DPRINTK(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
93	static unsigned char mfc3_read_data(struct parport *p)
94	{
95	/* clears interrupt bit. Triggers also /STROBE. */
96	return pia(p)->pprb;
97	}
98
99	static 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
114	static 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
128	static void mfc3_write_control(struct parport *p, unsigned char control)
129	{
130	DPRINTK(KERN_DEBUG "write_control %02x\n",control);
131	pia(p)->ppra = (pia(p)->ppra & 0x1f) \| control_pc_to_mfc3(control);
132	}
133
134	static unsigned char mfc3_read_control( struct parport *p)
135	{
136	DPRINTK(KERN_DEBUG "read_control \n");
137	return control_mfc3_to_pc(pia(p)->ppra & 0xe0);
138	}
139
140	static unsigned char mfc3_frob_control( struct parport *p, unsigned char mask, unsigned char val)
141	{
142	unsigned char old;
143
144	DPRINTK(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 */
151	static 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
169	static 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 */
188	static void mfc3_write_status( struct parport *p, unsigned char status)
189	{
190	DPRINTK(KERN_DEBUG "write_status %02x\n",status);
191	pia(p)->ppra = (pia(p)->ppra & 0xe0) \| status_pc_to_mfc3(status);
192	}
193	#endif
194
195	static unsigned char mfc3_read_status(struct parport *p)
196	{
197	unsigned char status;
198
199	status = status_mfc3_to_pc(pia(p)->ppra & 0x1f);
200	DPRINTK(KERN_DEBUG "read_status %02x\n", status);
201	return status;
202	}
203
204	#if 0 /* currently unused */
205	static 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
212	static int use_cnt = 0;
213
7d12e780	214	static irqreturn_t mfc3_interrupt(int irq, void *dev_id)
1da177e4 LT	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 */
f230d101	222	parport_generic_irq(this_port[i]);
1da177e4 LT	223	}
	224	return IRQ_HANDLED;
	225	}
	226
	227	static void mfc3_enable_irq(struct parport *p)
	228	{
	229	pia(p)->crb \|= PIA_C1_ENABLE_IRQ;
	230	}
	231
	232	static void mfc3_disable_irq(struct parport *p)
	233	{
	234	pia(p)->crb &= ~PIA_C1_ENABLE_IRQ;
	235	}
	236
	237	static 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
	245	static 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
	253	static 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
	261	static 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
	273	static 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
	285	static 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
323	static 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)
dace1453	356	if (request_irq(IRQ_AMIGA_PORTS, mfc3_interrupt, IRQF_SHARED, p->name, &pp_mfc3_ops))
1da177e4 LT	357	goto out_irq;
1da177e4 LT	358	}
c15a3837	359	p->dev = &z->dev;
1da177e4 LT	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
	381	static 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]);
49966bae	389	if (this_port[i]->irq != PARPORT_IRQ_NONE) {
1da177e4 LT	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
	399	MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
	400	MODULE_DESCRIPTION("Parport Driver for Multiface 3 expansion cards Paralllel Port");
	401	MODULE_SUPPORTED_DEVICE("Multiface 3 Parallel Port");
	402	MODULE_LICENSE("GPL");
	403
	404	module_init(parport_mfc3_init)
	405	module_exit(parport_mfc3_exit)