URL https://opencores.org/ocsvn/test_project/test_project/trunk

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [parport/] [parport_mfc3.c] - Blame information for rev 67

Go to most recent revision | Details | Compare with Previous | View Log


/* 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)

Browse

Tools

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [parport/] [parport_mfc3.c] - Blame information for rev 67

Line No.	Rev	Author	Line
1	62	marcus.erl	`/* 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
214			`static 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
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)`
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
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]);`
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
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)`