OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / parport / parport_amiga.c
blob8bef6d60f88b6f10a683ffae201530123c5c49e9
1 /* Low-level parallel port routines for the Amiga built-in port
3 * Author: Joerg Dorchain <joerg@dorchain.net>
5 * This is a complete rewrite of the code, but based heaviy upon the old
6 * lp_intern. code.
8 * The built-in Amiga parallel port provides one port at a fixed address
9 * with 8 bidirectional data lines (D0 - D7) and 3 bidirectional status
10 * lines (BUSY, POUT, SEL), 1 output control line /STROBE (raised automatically
11 * in hardware when the data register is accessed), and 1 input control line
12 * /ACK, able to cause an interrupt, but both not directly settable by
13 * software.
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/parport.h>
19 #include <linux/ioport.h>
20 #include <linux/interrupt.h>
21 #include <linux/platform_device.h>
23 #include <asm/setup.h>
24 #include <asm/amigahw.h>
25 #include <asm/irq.h>
26 #include <asm/io.h>
27 #include <asm/amigaints.h>
29 #undef DEBUG
30 #ifdef DEBUG
31 #define DPRINTK printk
32 #else
33 #define DPRINTK(x...) do { } while (0)
34 #endif
37 static void amiga_write_data(struct parport *p, unsigned char data)
39 DPRINTK(KERN_DEBUG "write_data %c\n",data);
40 /* Triggers also /STROBE. This behavior cannot be changed */
41 ciaa.prb = data;
42 mb();
45 static unsigned char amiga_read_data(struct parport *p)
47 /* Triggers also /STROBE. This behavior cannot be changed */
48 return ciaa.prb;
51 #if 0
52 static unsigned char control_pc_to_amiga(unsigned char control)
54 unsigned char ret = 0;
56 if (control & PARPORT_CONTROL_SELECT) /* XXX: What is SELECP? */
58 if (control & PARPORT_CONTROL_INIT) /* INITP */
59 /* reset connected to cpu reset pin */;
60 if (control & PARPORT_CONTROL_AUTOFD) /* AUTOLF */
61 /* Not connected */;
62 if (control & PARPORT_CONTROL_STROBE) /* Strobe */
63 /* Handled only directly by hardware */;
64 return ret;
66 #endif
68 static unsigned char control_amiga_to_pc(unsigned char control)
70 return PARPORT_CONTROL_SELECT |
71 PARPORT_CONTROL_AUTOFD | PARPORT_CONTROL_STROBE;
72 /* fake value: interrupt enable, select in, no reset,
73 no autolf, no strobe - seems to be closest the wiring diagram */
76 static void amiga_write_control(struct parport *p, unsigned char control)
78 DPRINTK(KERN_DEBUG "write_control %02x\n",control);
79 /* No implementation possible */
82 static unsigned char amiga_read_control( struct parport *p)
84 DPRINTK(KERN_DEBUG "read_control \n");
85 return control_amiga_to_pc(0);
88 static unsigned char amiga_frob_control( struct parport *p, unsigned char mask, unsigned char val)
90 unsigned char old;
92 DPRINTK(KERN_DEBUG "frob_control mask %02x, value %02x\n",mask,val);
93 old = amiga_read_control(p);
94 amiga_write_control(p, (old & ~mask) ^ val);
95 return old;
98 #if 0 /* currently unused */
99 static unsigned char status_pc_to_amiga(unsigned char status)
101 unsigned char ret = 1;
103 if (status & PARPORT_STATUS_BUSY) /* Busy */
104 ret &= ~1;
105 if (status & PARPORT_STATUS_ACK) /* Ack */
106 /* handled in hardware */;
107 if (status & PARPORT_STATUS_PAPEROUT) /* PaperOut */
108 ret |= 2;
109 if (status & PARPORT_STATUS_SELECT) /* select */
110 ret |= 4;
111 if (status & PARPORT_STATUS_ERROR) /* error */
112 /* not connected */;
113 return ret;
115 #endif
117 static unsigned char status_amiga_to_pc(unsigned char status)
119 unsigned char ret = PARPORT_STATUS_BUSY | PARPORT_STATUS_ACK | PARPORT_STATUS_ERROR;
121 if (status & 1) /* Busy */
122 ret &= ~PARPORT_STATUS_BUSY;
123 if (status & 2) /* PaperOut */
124 ret |= PARPORT_STATUS_PAPEROUT;
125 if (status & 4) /* Selected */
126 ret |= PARPORT_STATUS_SELECT;
127 /* the rest is not connected or handled autonomously in hardware */
129 return ret;
132 static unsigned char amiga_read_status(struct parport *p)
134 unsigned char status;
136 status = status_amiga_to_pc(ciab.pra & 7);
137 DPRINTK(KERN_DEBUG "read_status %02x\n", status);
138 return status;
141 static void amiga_enable_irq(struct parport *p)
143 enable_irq(IRQ_AMIGA_CIAA_FLG);
146 static void amiga_disable_irq(struct parport *p)
148 disable_irq(IRQ_AMIGA_CIAA_FLG);
151 static void amiga_data_forward(struct parport *p)
153 DPRINTK(KERN_DEBUG "forward\n");
154 ciaa.ddrb = 0xff; /* all pins output */
155 mb();
158 static void amiga_data_reverse(struct parport *p)
160 DPRINTK(KERN_DEBUG "reverse\n");
161 ciaa.ddrb = 0; /* all pins input */
162 mb();
165 static void amiga_init_state(struct pardevice *dev, struct parport_state *s)
167 s->u.amiga.data = 0;
168 s->u.amiga.datadir = 255;
169 s->u.amiga.status = 0;
170 s->u.amiga.statusdir = 0;
173 static void amiga_save_state(struct parport *p, struct parport_state *s)
175 mb();
176 s->u.amiga.data = ciaa.prb;
177 s->u.amiga.datadir = ciaa.ddrb;
178 s->u.amiga.status = ciab.pra & 7;
179 s->u.amiga.statusdir = ciab.ddra & 7;
180 mb();
183 static void amiga_restore_state(struct parport *p, struct parport_state *s)
185 mb();
186 ciaa.prb = s->u.amiga.data;
187 ciaa.ddrb = s->u.amiga.datadir;
188 ciab.pra |= (ciab.pra & 0xf8) | s->u.amiga.status;
189 ciab.ddra |= (ciab.ddra & 0xf8) | s->u.amiga.statusdir;
190 mb();
193 static struct parport_operations pp_amiga_ops = {
194 .write_data = amiga_write_data,
195 .read_data = amiga_read_data,
197 .write_control = amiga_write_control,
198 .read_control = amiga_read_control,
199 .frob_control = amiga_frob_control,
201 .read_status = amiga_read_status,
203 .enable_irq = amiga_enable_irq,
204 .disable_irq = amiga_disable_irq,
206 .data_forward = amiga_data_forward,
207 .data_reverse = amiga_data_reverse,
209 .init_state = amiga_init_state,
210 .save_state = amiga_save_state,
211 .restore_state = amiga_restore_state,
213 .epp_write_data = parport_ieee1284_epp_write_data,
214 .epp_read_data = parport_ieee1284_epp_read_data,
215 .epp_write_addr = parport_ieee1284_epp_write_addr,
216 .epp_read_addr = parport_ieee1284_epp_read_addr,
218 .ecp_write_data = parport_ieee1284_ecp_write_data,
219 .ecp_read_data = parport_ieee1284_ecp_read_data,
220 .ecp_write_addr = parport_ieee1284_ecp_write_addr,
222 .compat_write_data = parport_ieee1284_write_compat,
223 .nibble_read_data = parport_ieee1284_read_nibble,
224 .byte_read_data = parport_ieee1284_read_byte,
226 .owner = THIS_MODULE,
229 /* ----------- Initialisation code --------------------------------- */
231 static int __init amiga_parallel_probe(struct platform_device *pdev)
233 struct parport *p;
234 int err;
236 ciaa.ddrb = 0xff;
237 ciab.ddra &= 0xf8;
238 mb();
240 p = parport_register_port((unsigned long)&ciaa.prb, IRQ_AMIGA_CIAA_FLG,
241 PARPORT_DMA_NONE, &pp_amiga_ops);
242 if (!p)
243 return -EBUSY;
245 err = request_irq(IRQ_AMIGA_CIAA_FLG, parport_irq_handler, 0, p->name,
247 if (err)
248 goto out_irq;
250 printk(KERN_INFO "%s: Amiga built-in port using irq\n", p->name);
251 /* XXX: set operating mode */
252 parport_announce_port(p);
254 platform_set_drvdata(pdev, p);
256 return 0;
258 out_irq:
259 parport_put_port(p);
260 return err;
263 static int __exit amiga_parallel_remove(struct platform_device *pdev)
265 struct parport *port = platform_get_drvdata(pdev);
267 parport_remove_port(port);
268 if (port->irq != PARPORT_IRQ_NONE)
269 free_irq(IRQ_AMIGA_CIAA_FLG, port);
270 parport_put_port(port);
271 platform_set_drvdata(pdev, NULL);
272 return 0;
275 static struct platform_driver amiga_parallel_driver = {
276 .remove = __exit_p(amiga_parallel_remove),
277 .driver = {
278 .name = "amiga-parallel",
279 .owner = THIS_MODULE,
283 static int __init amiga_parallel_init(void)
285 return platform_driver_probe(&amiga_parallel_driver,
286 amiga_parallel_probe);
289 module_init(amiga_parallel_init);
291 static void __exit amiga_parallel_exit(void)
293 platform_driver_unregister(&amiga_parallel_driver);
296 module_exit(amiga_parallel_exit);
298 MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
299 MODULE_DESCRIPTION("Parport Driver for Amiga builtin Port");
300 MODULE_SUPPORTED_DEVICE("Amiga builtin Parallel Port");
301 MODULE_LICENSE("GPL");
302 MODULE_ALIAS("platform:amiga-parallel");