Commit | Line | Data |
---|---|---|
09c434b8 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
4f62d158 | 2 | /* parport_sunbpp.c: Parallel-port routines for SBUS |
1da177e4 LT |
3 | * |
4 | * Author: Derrick J. Brashear <shadow@dementia.org> | |
5 | * | |
6 | * based on work by: | |
7 | * Phil Blundell <philb@gnu.org> | |
8 | * Tim Waugh <tim@cyberelk.demon.co.uk> | |
9 | * Jose Renau <renau@acm.org> | |
10 | * David Campbell <campbell@tirian.che.curtin.edu.au> | |
11 | * Grant Guenther <grant@torque.net> | |
12 | * Eddie C. Dost <ecd@skynet.be> | |
13 | * Stephen Williams (steve@icarus.com) | |
14 | * Gus Baldauf (gbaldauf@ix.netcom.com) | |
15 | * Peter Zaitcev | |
16 | * Tom Dyas | |
4f62d158 DM |
17 | * |
18 | * Updated to new SBUS device framework: David S. Miller <davem@davemloft.net> | |
19 | * | |
1da177e4 LT |
20 | */ |
21 | ||
22 | #include <linux/string.h> | |
23 | #include <linux/module.h> | |
24 | #include <linux/delay.h> | |
25 | #include <linux/errno.h> | |
26 | #include <linux/ioport.h> | |
27 | #include <linux/kernel.h> | |
28 | #include <linux/slab.h> | |
29 | #include <linux/init.h> | |
27167e0e DM |
30 | #include <linux/of.h> |
31 | #include <linux/of_device.h> | |
1da177e4 LT |
32 | |
33 | #include <linux/parport.h> | |
34 | ||
35 | #include <asm/ptrace.h> | |
36 | #include <linux/interrupt.h> | |
37 | ||
38 | #include <asm/io.h> | |
39 | #include <asm/oplib.h> /* OpenProm Library */ | |
1da177e4 LT |
40 | #include <asm/dma.h> /* BPP uses LSI 64854 for DMA */ |
41 | #include <asm/irq.h> | |
42 | #include <asm/sunbpp.h> | |
43 | ||
44 | #undef __SUNBPP_DEBUG | |
45 | #ifdef __SUNBPP_DEBUG | |
46 | #define dprintk(x) printk x | |
47 | #else | |
48 | #define dprintk(x) | |
49 | #endif | |
50 | ||
1da177e4 LT |
51 | static void parport_sunbpp_disable_irq(struct parport *p) |
52 | { | |
53 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
54 | u32 tmp; | |
55 | ||
56 | tmp = sbus_readl(®s->p_csr); | |
57 | tmp &= ~DMA_INT_ENAB; | |
58 | sbus_writel(tmp, ®s->p_csr); | |
59 | } | |
60 | ||
61 | static void parport_sunbpp_enable_irq(struct parport *p) | |
62 | { | |
63 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
64 | u32 tmp; | |
65 | ||
66 | tmp = sbus_readl(®s->p_csr); | |
67 | tmp |= DMA_INT_ENAB; | |
68 | sbus_writel(tmp, ®s->p_csr); | |
69 | } | |
70 | ||
71 | static void parport_sunbpp_write_data(struct parport *p, unsigned char d) | |
72 | { | |
73 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
74 | ||
75 | sbus_writeb(d, ®s->p_dr); | |
76 | dprintk((KERN_DEBUG "wrote 0x%x\n", d)); | |
77 | } | |
78 | ||
79 | static unsigned char parport_sunbpp_read_data(struct parport *p) | |
80 | { | |
81 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
82 | ||
83 | return sbus_readb(®s->p_dr); | |
84 | } | |
85 | ||
1da177e4 LT |
86 | static unsigned char status_sunbpp_to_pc(struct parport *p) |
87 | { | |
88 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
89 | unsigned char bits = 0; | |
90 | unsigned char value_tcr = sbus_readb(®s->p_tcr); | |
91 | unsigned char value_ir = sbus_readb(®s->p_ir); | |
92 | ||
93 | if (!(value_ir & P_IR_ERR)) | |
94 | bits |= PARPORT_STATUS_ERROR; | |
95 | if (!(value_ir & P_IR_SLCT)) | |
96 | bits |= PARPORT_STATUS_SELECT; | |
97 | if (!(value_ir & P_IR_PE)) | |
98 | bits |= PARPORT_STATUS_PAPEROUT; | |
99 | if (value_tcr & P_TCR_ACK) | |
100 | bits |= PARPORT_STATUS_ACK; | |
101 | if (!(value_tcr & P_TCR_BUSY)) | |
102 | bits |= PARPORT_STATUS_BUSY; | |
103 | ||
5a68b2e3 | 104 | dprintk((KERN_DEBUG "tcr 0x%x ir 0x%x\n", value_tcr, value_ir)); |
1da177e4 LT |
105 | dprintk((KERN_DEBUG "read status 0x%x\n", bits)); |
106 | return bits; | |
107 | } | |
108 | ||
109 | static unsigned char control_sunbpp_to_pc(struct parport *p) | |
110 | { | |
111 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
112 | unsigned char bits = 0; | |
113 | unsigned char value_tcr = sbus_readb(®s->p_tcr); | |
114 | unsigned char value_or = sbus_readb(®s->p_or); | |
115 | ||
116 | if (!(value_tcr & P_TCR_DS)) | |
117 | bits |= PARPORT_CONTROL_STROBE; | |
118 | if (!(value_or & P_OR_AFXN)) | |
119 | bits |= PARPORT_CONTROL_AUTOFD; | |
120 | if (!(value_or & P_OR_INIT)) | |
121 | bits |= PARPORT_CONTROL_INIT; | |
122 | if (value_or & P_OR_SLCT_IN) | |
123 | bits |= PARPORT_CONTROL_SELECT; | |
124 | ||
5a68b2e3 | 125 | dprintk((KERN_DEBUG "tcr 0x%x or 0x%x\n", value_tcr, value_or)); |
1da177e4 LT |
126 | dprintk((KERN_DEBUG "read control 0x%x\n", bits)); |
127 | return bits; | |
128 | } | |
129 | ||
130 | static unsigned char parport_sunbpp_read_control(struct parport *p) | |
131 | { | |
132 | return control_sunbpp_to_pc(p); | |
133 | } | |
134 | ||
135 | static unsigned char parport_sunbpp_frob_control(struct parport *p, | |
136 | unsigned char mask, | |
137 | unsigned char val) | |
138 | { | |
139 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
140 | unsigned char value_tcr = sbus_readb(®s->p_tcr); | |
141 | unsigned char value_or = sbus_readb(®s->p_or); | |
142 | ||
5a68b2e3 DM |
143 | dprintk((KERN_DEBUG "frob1: tcr 0x%x or 0x%x\n", |
144 | value_tcr, value_or)); | |
1da177e4 LT |
145 | if (mask & PARPORT_CONTROL_STROBE) { |
146 | if (val & PARPORT_CONTROL_STROBE) { | |
147 | value_tcr &= ~P_TCR_DS; | |
148 | } else { | |
149 | value_tcr |= P_TCR_DS; | |
150 | } | |
151 | } | |
152 | if (mask & PARPORT_CONTROL_AUTOFD) { | |
153 | if (val & PARPORT_CONTROL_AUTOFD) { | |
154 | value_or &= ~P_OR_AFXN; | |
155 | } else { | |
156 | value_or |= P_OR_AFXN; | |
157 | } | |
158 | } | |
159 | if (mask & PARPORT_CONTROL_INIT) { | |
160 | if (val & PARPORT_CONTROL_INIT) { | |
161 | value_or &= ~P_OR_INIT; | |
162 | } else { | |
163 | value_or |= P_OR_INIT; | |
164 | } | |
165 | } | |
166 | if (mask & PARPORT_CONTROL_SELECT) { | |
167 | if (val & PARPORT_CONTROL_SELECT) { | |
168 | value_or |= P_OR_SLCT_IN; | |
169 | } else { | |
170 | value_or &= ~P_OR_SLCT_IN; | |
171 | } | |
172 | } | |
173 | ||
174 | sbus_writeb(value_or, ®s->p_or); | |
175 | sbus_writeb(value_tcr, ®s->p_tcr); | |
5a68b2e3 DM |
176 | dprintk((KERN_DEBUG "frob2: tcr 0x%x or 0x%x\n", |
177 | value_tcr, value_or)); | |
1da177e4 LT |
178 | return parport_sunbpp_read_control(p); |
179 | } | |
180 | ||
181 | static void parport_sunbpp_write_control(struct parport *p, unsigned char d) | |
182 | { | |
183 | const unsigned char wm = (PARPORT_CONTROL_STROBE | | |
184 | PARPORT_CONTROL_AUTOFD | | |
185 | PARPORT_CONTROL_INIT | | |
186 | PARPORT_CONTROL_SELECT); | |
187 | ||
188 | parport_sunbpp_frob_control (p, wm, d & wm); | |
189 | } | |
190 | ||
191 | static unsigned char parport_sunbpp_read_status(struct parport *p) | |
192 | { | |
193 | return status_sunbpp_to_pc(p); | |
194 | } | |
195 | ||
196 | static void parport_sunbpp_data_forward (struct parport *p) | |
197 | { | |
198 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
199 | unsigned char value_tcr = sbus_readb(®s->p_tcr); | |
200 | ||
201 | dprintk((KERN_DEBUG "forward\n")); | |
202 | value_tcr &= ~P_TCR_DIR; | |
203 | sbus_writeb(value_tcr, ®s->p_tcr); | |
204 | } | |
205 | ||
206 | static void parport_sunbpp_data_reverse (struct parport *p) | |
207 | { | |
208 | struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base; | |
209 | u8 val = sbus_readb(®s->p_tcr); | |
210 | ||
211 | dprintk((KERN_DEBUG "reverse\n")); | |
212 | val |= P_TCR_DIR; | |
213 | sbus_writeb(val, ®s->p_tcr); | |
214 | } | |
215 | ||
216 | static void parport_sunbpp_init_state(struct pardevice *dev, struct parport_state *s) | |
217 | { | |
218 | s->u.pc.ctr = 0xc; | |
219 | s->u.pc.ecr = 0x0; | |
220 | } | |
221 | ||
222 | static void parport_sunbpp_save_state(struct parport *p, struct parport_state *s) | |
223 | { | |
224 | s->u.pc.ctr = parport_sunbpp_read_control(p); | |
225 | } | |
226 | ||
227 | static void parport_sunbpp_restore_state(struct parport *p, struct parport_state *s) | |
228 | { | |
229 | parport_sunbpp_write_control(p, s->u.pc.ctr); | |
230 | } | |
231 | ||
232 | static struct parport_operations parport_sunbpp_ops = | |
233 | { | |
234 | .write_data = parport_sunbpp_write_data, | |
235 | .read_data = parport_sunbpp_read_data, | |
236 | ||
237 | .write_control = parport_sunbpp_write_control, | |
238 | .read_control = parport_sunbpp_read_control, | |
239 | .frob_control = parport_sunbpp_frob_control, | |
240 | ||
241 | .read_status = parport_sunbpp_read_status, | |
242 | ||
243 | .enable_irq = parport_sunbpp_enable_irq, | |
244 | .disable_irq = parport_sunbpp_disable_irq, | |
245 | ||
246 | .data_forward = parport_sunbpp_data_forward, | |
247 | .data_reverse = parport_sunbpp_data_reverse, | |
248 | ||
249 | .init_state = parport_sunbpp_init_state, | |
250 | .save_state = parport_sunbpp_save_state, | |
251 | .restore_state = parport_sunbpp_restore_state, | |
252 | ||
253 | .epp_write_data = parport_ieee1284_epp_write_data, | |
254 | .epp_read_data = parport_ieee1284_epp_read_data, | |
255 | .epp_write_addr = parport_ieee1284_epp_write_addr, | |
256 | .epp_read_addr = parport_ieee1284_epp_read_addr, | |
257 | ||
258 | .ecp_write_data = parport_ieee1284_ecp_write_data, | |
259 | .ecp_read_data = parport_ieee1284_ecp_read_data, | |
260 | .ecp_write_addr = parport_ieee1284_ecp_write_addr, | |
261 | ||
262 | .compat_write_data = parport_ieee1284_write_compat, | |
263 | .nibble_read_data = parport_ieee1284_read_nibble, | |
264 | .byte_read_data = parport_ieee1284_read_byte, | |
265 | ||
266 | .owner = THIS_MODULE, | |
267 | }; | |
268 | ||
312facaf | 269 | static int bpp_probe(struct platform_device *op) |
1da177e4 | 270 | { |
1da177e4 | 271 | struct parport_operations *ops; |
1da177e4 | 272 | struct bpp_regs __iomem *regs; |
27167e0e | 273 | int irq, dma, err = 0, size; |
1da177e4 | 274 | unsigned char value_tcr; |
27167e0e DM |
275 | void __iomem *base; |
276 | struct parport *p; | |
1da177e4 | 277 | |
1636f8ac | 278 | irq = op->archdata.irqs[0]; |
27167e0e DM |
279 | base = of_ioremap(&op->resource[0], 0, |
280 | resource_size(&op->resource[0]), | |
281 | "sunbpp"); | |
1da177e4 | 282 | if (!base) |
4f62d158 | 283 | return -ENODEV; |
1da177e4 | 284 | |
27167e0e | 285 | size = resource_size(&op->resource[0]); |
1da177e4 LT |
286 | dma = PARPORT_DMA_NONE; |
287 | ||
2451a848 SMP |
288 | ops = kmemdup(&parport_sunbpp_ops, sizeof(struct parport_operations), |
289 | GFP_KERNEL); | |
faa1a473 JL |
290 | if (!ops) { |
291 | err = -ENOMEM; | |
4f62d158 | 292 | goto out_unmap; |
faa1a473 | 293 | } |
1da177e4 | 294 | |
1da177e4 | 295 | dprintk(("register_port\n")); |
faa1a473 JL |
296 | if (!(p = parport_register_port((unsigned long)base, irq, dma, ops))) { |
297 | err = -ENOMEM; | |
4f62d158 | 298 | goto out_free_ops; |
faa1a473 | 299 | } |
1da177e4 LT |
300 | |
301 | p->size = size; | |
27167e0e | 302 | p->dev = &op->dev; |
1da177e4 | 303 | |
3f2e40df | 304 | if ((err = request_irq(p->irq, parport_irq_handler, |
dace1453 | 305 | IRQF_SHARED, p->name, p)) != 0) { |
4f62d158 | 306 | goto out_put_port; |
1da177e4 | 307 | } |
4f62d158 | 308 | |
1da177e4 LT |
309 | parport_sunbpp_enable_irq(p); |
310 | ||
311 | regs = (struct bpp_regs __iomem *)p->base; | |
4f62d158 | 312 | |
1da177e4 LT |
313 | value_tcr = sbus_readb(®s->p_tcr); |
314 | value_tcr &= ~P_TCR_DIR; | |
315 | sbus_writeb(value_tcr, ®s->p_tcr); | |
316 | ||
decf26f6 | 317 | pr_info("%s: sunbpp at 0x%lx\n", p->name, p->base); |
1da177e4 | 318 | |
27167e0e | 319 | dev_set_drvdata(&op->dev, p); |
4f62d158 DM |
320 | |
321 | parport_announce_port(p); | |
322 | ||
323 | return 0; | |
1da177e4 | 324 | |
4f62d158 | 325 | out_put_port: |
1da177e4 | 326 | parport_put_port(p); |
4f62d158 DM |
327 | |
328 | out_free_ops: | |
1da177e4 | 329 | kfree(ops); |
4f62d158 DM |
330 | |
331 | out_unmap: | |
27167e0e | 332 | of_iounmap(&op->resource[0], base, size); |
4f62d158 | 333 | |
1da177e4 LT |
334 | return err; |
335 | } | |
336 | ||
312facaf | 337 | static int bpp_remove(struct platform_device *op) |
4f62d158 | 338 | { |
27167e0e | 339 | struct parport *p = dev_get_drvdata(&op->dev); |
4f62d158 DM |
340 | struct parport_operations *ops = p->ops; |
341 | ||
342 | parport_remove_port(p); | |
343 | ||
344 | if (p->irq != PARPORT_IRQ_NONE) { | |
345 | parport_sunbpp_disable_irq(p); | |
346 | free_irq(p->irq, p); | |
1da177e4 | 347 | } |
4f62d158 | 348 | |
27167e0e | 349 | of_iounmap(&op->resource[0], (void __iomem *) p->base, p->size); |
4f62d158 DM |
350 | parport_put_port(p); |
351 | kfree(ops); | |
352 | ||
27167e0e | 353 | dev_set_drvdata(&op->dev, NULL); |
4f62d158 DM |
354 | |
355 | return 0; | |
356 | } | |
357 | ||
fd098316 | 358 | static const struct of_device_id bpp_match[] = { |
4f62d158 DM |
359 | { |
360 | .name = "SUNW,bpp", | |
361 | }, | |
362 | {}, | |
363 | }; | |
364 | ||
09ec4314 | 365 | MODULE_DEVICE_TABLE(of, bpp_match); |
4f62d158 | 366 | |
4ebb24f7 | 367 | static struct platform_driver bpp_sbus_driver = { |
4018294b GL |
368 | .driver = { |
369 | .name = "bpp", | |
4018294b GL |
370 | .of_match_table = bpp_match, |
371 | }, | |
4f62d158 | 372 | .probe = bpp_probe, |
312facaf | 373 | .remove = bpp_remove, |
4f62d158 DM |
374 | }; |
375 | ||
782ee877 | 376 | module_platform_driver(bpp_sbus_driver); |
1da177e4 LT |
377 | |
378 | MODULE_AUTHOR("Derrick J Brashear"); | |
379 | MODULE_DESCRIPTION("Parport Driver for Sparc bidirectional Port"); | |
4f62d158 | 380 | MODULE_VERSION("2.0"); |
1da177e4 | 381 | MODULE_LICENSE("GPL"); |