Commit | Line | Data |
---|---|---|
b2441318 | 1 | // SPDX-License-Identifier: GPL-2.0 |
1da177e4 LT |
2 | /* IEEE-1284 operations for parport. |
3 | * | |
4 | * This file is for generic IEEE 1284 operations. The idea is that | |
5 | * they are used by the low-level drivers. If they have a special way | |
6 | * of doing something, they can provide their own routines (and put | |
7 | * the function pointers in port->ops); if not, they can just use these | |
8 | * as a fallback. | |
9 | * | |
10 | * Note: Make no assumptions about hardware or architecture in this file! | |
11 | * | |
12 | * Author: Tim Waugh <tim@cyberelk.demon.co.uk> | |
13 | * Fixed AUTOFD polarity in ecp_forward_to_reverse(). Fred Barnes, 1999 | |
14 | * Software emulated EPP fixes, Fred Barnes, 04/2001. | |
15 | */ | |
16 | ||
17 | ||
1da177e4 LT |
18 | #include <linux/module.h> |
19 | #include <linux/parport.h> | |
20 | #include <linux/delay.h> | |
174cd4b1 | 21 | #include <linux/sched/signal.h> |
7c0f6ba6 | 22 | #include <linux/uaccess.h> |
1da177e4 LT |
23 | |
24 | #undef DEBUG /* undef me for production */ | |
25 | ||
26 | #ifdef CONFIG_LP_CONSOLE | |
27 | #undef DEBUG /* Don't want a garbled console */ | |
28 | #endif | |
29 | ||
1da177e4 LT |
30 | /*** * |
31 | * One-way data transfer functions. * | |
32 | * ***/ | |
33 | ||
34 | /* Compatibility mode. */ | |
35 | size_t parport_ieee1284_write_compat (struct parport *port, | |
36 | const void *buffer, size_t len, | |
37 | int flags) | |
38 | { | |
39 | int no_irq = 1; | |
40 | ssize_t count = 0; | |
41 | const unsigned char *addr = buffer; | |
42 | unsigned char byte; | |
43 | struct pardevice *dev = port->physport->cad; | |
44 | unsigned char ctl = (PARPORT_CONTROL_SELECT | |
45 | | PARPORT_CONTROL_INIT); | |
46 | ||
47 | if (port->irq != PARPORT_IRQ_NONE) { | |
48 | parport_enable_irq (port); | |
49 | no_irq = 0; | |
50 | } | |
51 | ||
52 | port->physport->ieee1284.phase = IEEE1284_PH_FWD_DATA; | |
53 | parport_write_control (port, ctl); | |
54 | parport_data_forward (port); | |
55 | while (count < len) { | |
56 | unsigned long expire = jiffies + dev->timeout; | |
7b4ccf8d | 57 | long wait = msecs_to_jiffies(10); |
1da177e4 LT |
58 | unsigned char mask = (PARPORT_STATUS_ERROR |
59 | | PARPORT_STATUS_BUSY); | |
60 | unsigned char val = (PARPORT_STATUS_ERROR | |
61 | | PARPORT_STATUS_BUSY); | |
62 | ||
63 | /* Wait until the peripheral's ready */ | |
64 | do { | |
65 | /* Is the peripheral ready yet? */ | |
66 | if (!parport_wait_peripheral (port, mask, val)) | |
67 | /* Skip the loop */ | |
68 | goto ready; | |
69 | ||
70 | /* Is the peripheral upset? */ | |
71 | if ((parport_read_status (port) & | |
72 | (PARPORT_STATUS_PAPEROUT | | |
73 | PARPORT_STATUS_SELECT | | |
74 | PARPORT_STATUS_ERROR)) | |
75 | != (PARPORT_STATUS_SELECT | | |
76 | PARPORT_STATUS_ERROR)) | |
77 | /* If nFault is asserted (i.e. no | |
78 | * error) and PAPEROUT and SELECT are | |
79 | * just red herrings, give the driver | |
80 | * a chance to check it's happy with | |
81 | * that before continuing. */ | |
82 | goto stop; | |
83 | ||
84 | /* Have we run out of time? */ | |
85 | if (!time_before (jiffies, expire)) | |
86 | break; | |
87 | ||
88 | /* Yield the port for a while. If this is the | |
89 | first time around the loop, don't let go of | |
90 | the port. This way, we find out if we have | |
91 | our interrupt handler called. */ | |
92 | if (count && no_irq) { | |
93 | parport_release (dev); | |
7b4ccf8d | 94 | schedule_timeout_interruptible(wait); |
1da177e4 LT |
95 | parport_claim_or_block (dev); |
96 | } | |
97 | else | |
98 | /* We must have the device claimed here */ | |
99 | parport_wait_event (port, wait); | |
100 | ||
101 | /* Is there a signal pending? */ | |
102 | if (signal_pending (current)) | |
103 | break; | |
104 | ||
105 | /* Wait longer next time. */ | |
106 | wait *= 2; | |
107 | } while (time_before (jiffies, expire)); | |
108 | ||
109 | if (signal_pending (current)) | |
110 | break; | |
111 | ||
d98ce9fe | 112 | pr_debug("%s: Timed out\n", port->name); |
1da177e4 LT |
113 | break; |
114 | ||
115 | ready: | |
116 | /* Write the character to the data lines. */ | |
117 | byte = *addr++; | |
118 | parport_write_data (port, byte); | |
119 | udelay (1); | |
120 | ||
121 | /* Pulse strobe. */ | |
122 | parport_write_control (port, ctl | PARPORT_CONTROL_STROBE); | |
123 | udelay (1); /* strobe */ | |
124 | ||
125 | parport_write_control (port, ctl); | |
126 | udelay (1); /* hold */ | |
127 | ||
128 | /* Assume the peripheral received it. */ | |
129 | count++; | |
130 | ||
131 | /* Let another process run if it needs to. */ | |
132 | if (time_before (jiffies, expire)) | |
133 | if (!parport_yield_blocking (dev) | |
134 | && need_resched()) | |
135 | schedule (); | |
136 | } | |
137 | stop: | |
138 | port->physport->ieee1284.phase = IEEE1284_PH_FWD_IDLE; | |
139 | ||
140 | return count; | |
141 | } | |
142 | ||
143 | /* Nibble mode. */ | |
144 | size_t parport_ieee1284_read_nibble (struct parport *port, | |
145 | void *buffer, size_t len, | |
146 | int flags) | |
147 | { | |
148 | #ifndef CONFIG_PARPORT_1284 | |
149 | return 0; | |
150 | #else | |
151 | unsigned char *buf = buffer; | |
152 | int i; | |
153 | unsigned char byte = 0; | |
154 | ||
155 | len *= 2; /* in nibbles */ | |
156 | for (i=0; i < len; i++) { | |
157 | unsigned char nibble; | |
158 | ||
159 | /* Does the error line indicate end of data? */ | |
160 | if (((i & 1) == 0) && | |
161 | (parport_read_status(port) & PARPORT_STATUS_ERROR)) { | |
742ec650 | 162 | goto end_of_data; |
1da177e4 LT |
163 | } |
164 | ||
165 | /* Event 7: Set nAutoFd low. */ | |
166 | parport_frob_control (port, | |
167 | PARPORT_CONTROL_AUTOFD, | |
168 | PARPORT_CONTROL_AUTOFD); | |
169 | ||
170 | /* Event 9: nAck goes low. */ | |
171 | port->ieee1284.phase = IEEE1284_PH_REV_DATA; | |
172 | if (parport_wait_peripheral (port, | |
173 | PARPORT_STATUS_ACK, 0)) { | |
174 | /* Timeout -- no more data? */ | |
d98ce9fe JP |
175 | pr_debug("%s: Nibble timeout at event 9 (%d bytes)\n", |
176 | port->name, i / 2); | |
1da177e4 LT |
177 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0); |
178 | break; | |
179 | } | |
180 | ||
181 | ||
182 | /* Read a nibble. */ | |
183 | nibble = parport_read_status (port) >> 3; | |
184 | nibble &= ~8; | |
185 | if ((nibble & 0x10) == 0) | |
186 | nibble |= 8; | |
187 | nibble &= 0xf; | |
188 | ||
189 | /* Event 10: Set nAutoFd high. */ | |
190 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0); | |
191 | ||
192 | /* Event 11: nAck goes high. */ | |
193 | if (parport_wait_peripheral (port, | |
194 | PARPORT_STATUS_ACK, | |
195 | PARPORT_STATUS_ACK)) { | |
196 | /* Timeout -- no more data? */ | |
d98ce9fe | 197 | pr_debug("%s: Nibble timeout at event 11\n", |
1da177e4 LT |
198 | port->name); |
199 | break; | |
200 | } | |
201 | ||
202 | if (i & 1) { | |
203 | /* Second nibble */ | |
204 | byte |= nibble << 4; | |
205 | *buf++ = byte; | |
206 | } else | |
207 | byte = nibble; | |
208 | } | |
209 | ||
1da177e4 LT |
210 | if (i == len) { |
211 | /* Read the last nibble without checking data avail. */ | |
742ec650 MK |
212 | if (parport_read_status (port) & PARPORT_STATUS_ERROR) { |
213 | end_of_data: | |
d98ce9fe JP |
214 | pr_debug("%s: No more nibble data (%d bytes)\n", |
215 | port->name, i / 2); | |
742ec650 MK |
216 | |
217 | /* Go to reverse idle phase. */ | |
218 | parport_frob_control (port, | |
219 | PARPORT_CONTROL_AUTOFD, | |
220 | PARPORT_CONTROL_AUTOFD); | |
221 | port->physport->ieee1284.phase = IEEE1284_PH_REV_IDLE; | |
222 | } | |
1da177e4 | 223 | else |
742ec650 | 224 | port->physport->ieee1284.phase = IEEE1284_PH_HBUSY_DAVAIL; |
1da177e4 LT |
225 | } |
226 | ||
742ec650 | 227 | return i/2; |
1da177e4 LT |
228 | #endif /* IEEE1284 support */ |
229 | } | |
230 | ||
231 | /* Byte mode. */ | |
232 | size_t parport_ieee1284_read_byte (struct parport *port, | |
233 | void *buffer, size_t len, | |
234 | int flags) | |
235 | { | |
236 | #ifndef CONFIG_PARPORT_1284 | |
237 | return 0; | |
238 | #else | |
239 | unsigned char *buf = buffer; | |
240 | ssize_t count = 0; | |
241 | ||
242 | for (count = 0; count < len; count++) { | |
243 | unsigned char byte; | |
244 | ||
245 | /* Data available? */ | |
246 | if (parport_read_status (port) & PARPORT_STATUS_ERROR) { | |
742ec650 | 247 | goto end_of_data; |
1da177e4 LT |
248 | } |
249 | ||
250 | /* Event 14: Place data bus in high impedance state. */ | |
251 | parport_data_reverse (port); | |
252 | ||
253 | /* Event 7: Set nAutoFd low. */ | |
254 | parport_frob_control (port, | |
255 | PARPORT_CONTROL_AUTOFD, | |
256 | PARPORT_CONTROL_AUTOFD); | |
257 | ||
258 | /* Event 9: nAck goes low. */ | |
259 | port->physport->ieee1284.phase = IEEE1284_PH_REV_DATA; | |
260 | if (parport_wait_peripheral (port, | |
261 | PARPORT_STATUS_ACK, | |
262 | 0)) { | |
263 | /* Timeout -- no more data? */ | |
264 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, | |
265 | 0); | |
d98ce9fe | 266 | pr_debug("%s: Byte timeout at event 9\n", port->name); |
1da177e4 LT |
267 | break; |
268 | } | |
269 | ||
270 | byte = parport_read_data (port); | |
271 | *buf++ = byte; | |
272 | ||
273 | /* Event 10: Set nAutoFd high */ | |
274 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0); | |
275 | ||
276 | /* Event 11: nAck goes high. */ | |
277 | if (parport_wait_peripheral (port, | |
278 | PARPORT_STATUS_ACK, | |
279 | PARPORT_STATUS_ACK)) { | |
280 | /* Timeout -- no more data? */ | |
d98ce9fe | 281 | pr_debug("%s: Byte timeout at event 11\n", port->name); |
1da177e4 LT |
282 | break; |
283 | } | |
284 | ||
285 | /* Event 16: Set nStrobe low. */ | |
286 | parport_frob_control (port, | |
287 | PARPORT_CONTROL_STROBE, | |
288 | PARPORT_CONTROL_STROBE); | |
289 | udelay (5); | |
290 | ||
291 | /* Event 17: Set nStrobe high. */ | |
292 | parport_frob_control (port, PARPORT_CONTROL_STROBE, 0); | |
293 | } | |
294 | ||
295 | if (count == len) { | |
296 | /* Read the last byte without checking data avail. */ | |
742ec650 MK |
297 | if (parport_read_status (port) & PARPORT_STATUS_ERROR) { |
298 | end_of_data: | |
d98ce9fe | 299 | pr_debug("%s: No more byte data (%zd bytes)\n", |
742ec650 MK |
300 | port->name, count); |
301 | ||
302 | /* Go to reverse idle phase. */ | |
303 | parport_frob_control (port, | |
304 | PARPORT_CONTROL_AUTOFD, | |
305 | PARPORT_CONTROL_AUTOFD); | |
306 | port->physport->ieee1284.phase = IEEE1284_PH_REV_IDLE; | |
307 | } | |
1da177e4 | 308 | else |
742ec650 | 309 | port->physport->ieee1284.phase = IEEE1284_PH_HBUSY_DAVAIL; |
1da177e4 LT |
310 | } |
311 | ||
312 | return count; | |
313 | #endif /* IEEE1284 support */ | |
314 | } | |
315 | ||
316 | /*** * | |
317 | * ECP Functions. * | |
318 | * ***/ | |
319 | ||
320 | #ifdef CONFIG_PARPORT_1284 | |
321 | ||
322 | static inline | |
323 | int ecp_forward_to_reverse (struct parport *port) | |
324 | { | |
325 | int retval; | |
326 | ||
327 | /* Event 38: Set nAutoFd low */ | |
328 | parport_frob_control (port, | |
329 | PARPORT_CONTROL_AUTOFD, | |
330 | PARPORT_CONTROL_AUTOFD); | |
331 | parport_data_reverse (port); | |
332 | udelay (5); | |
333 | ||
334 | /* Event 39: Set nInit low to initiate bus reversal */ | |
335 | parport_frob_control (port, | |
336 | PARPORT_CONTROL_INIT, | |
337 | 0); | |
338 | ||
339 | /* Event 40: PError goes low */ | |
340 | retval = parport_wait_peripheral (port, | |
341 | PARPORT_STATUS_PAPEROUT, 0); | |
342 | ||
343 | if (!retval) { | |
d98ce9fe | 344 | pr_debug("%s: ECP direction: reverse\n", port->name); |
1da177e4 LT |
345 | port->ieee1284.phase = IEEE1284_PH_REV_IDLE; |
346 | } else { | |
d98ce9fe | 347 | pr_debug("%s: ECP direction: failed to reverse\n", port->name); |
1da177e4 LT |
348 | port->ieee1284.phase = IEEE1284_PH_ECP_DIR_UNKNOWN; |
349 | } | |
350 | ||
351 | return retval; | |
352 | } | |
353 | ||
354 | static inline | |
355 | int ecp_reverse_to_forward (struct parport *port) | |
356 | { | |
357 | int retval; | |
358 | ||
359 | /* Event 47: Set nInit high */ | |
360 | parport_frob_control (port, | |
361 | PARPORT_CONTROL_INIT | |
362 | | PARPORT_CONTROL_AUTOFD, | |
363 | PARPORT_CONTROL_INIT | |
364 | | PARPORT_CONTROL_AUTOFD); | |
365 | ||
366 | /* Event 49: PError goes high */ | |
367 | retval = parport_wait_peripheral (port, | |
368 | PARPORT_STATUS_PAPEROUT, | |
369 | PARPORT_STATUS_PAPEROUT); | |
370 | ||
371 | if (!retval) { | |
372 | parport_data_forward (port); | |
d98ce9fe | 373 | pr_debug("%s: ECP direction: forward\n", port->name); |
1da177e4 LT |
374 | port->ieee1284.phase = IEEE1284_PH_FWD_IDLE; |
375 | } else { | |
d98ce9fe | 376 | pr_debug("%s: ECP direction: failed to switch forward\n", |
1da177e4 LT |
377 | port->name); |
378 | port->ieee1284.phase = IEEE1284_PH_ECP_DIR_UNKNOWN; | |
379 | } | |
380 | ||
381 | ||
382 | return retval; | |
383 | } | |
384 | ||
385 | #endif /* IEEE1284 support */ | |
386 | ||
387 | /* ECP mode, forward channel, data. */ | |
388 | size_t parport_ieee1284_ecp_write_data (struct parport *port, | |
389 | const void *buffer, size_t len, | |
390 | int flags) | |
391 | { | |
392 | #ifndef CONFIG_PARPORT_1284 | |
393 | return 0; | |
394 | #else | |
395 | const unsigned char *buf = buffer; | |
396 | size_t written; | |
397 | int retry; | |
398 | ||
399 | port = port->physport; | |
400 | ||
401 | if (port->ieee1284.phase != IEEE1284_PH_FWD_IDLE) | |
402 | if (ecp_reverse_to_forward (port)) | |
403 | return 0; | |
404 | ||
405 | port->ieee1284.phase = IEEE1284_PH_FWD_DATA; | |
406 | ||
407 | /* HostAck high (data, not command) */ | |
408 | parport_frob_control (port, | |
409 | PARPORT_CONTROL_AUTOFD | |
410 | | PARPORT_CONTROL_STROBE | |
411 | | PARPORT_CONTROL_INIT, | |
412 | PARPORT_CONTROL_INIT); | |
413 | for (written = 0; written < len; written++, buf++) { | |
414 | unsigned long expire = jiffies + port->cad->timeout; | |
415 | unsigned char byte; | |
416 | ||
417 | byte = *buf; | |
418 | try_again: | |
419 | parport_write_data (port, byte); | |
420 | parport_frob_control (port, PARPORT_CONTROL_STROBE, | |
421 | PARPORT_CONTROL_STROBE); | |
422 | udelay (5); | |
423 | for (retry = 0; retry < 100; retry++) { | |
424 | if (!parport_wait_peripheral (port, | |
425 | PARPORT_STATUS_BUSY, 0)) | |
426 | goto success; | |
427 | ||
428 | if (signal_pending (current)) { | |
429 | parport_frob_control (port, | |
430 | PARPORT_CONTROL_STROBE, | |
431 | 0); | |
432 | break; | |
433 | } | |
434 | } | |
435 | ||
436 | /* Time for Host Transfer Recovery (page 41 of IEEE1284) */ | |
d98ce9fe | 437 | pr_debug("%s: ECP transfer stalled!\n", port->name); |
1da177e4 LT |
438 | |
439 | parport_frob_control (port, PARPORT_CONTROL_INIT, | |
440 | PARPORT_CONTROL_INIT); | |
441 | udelay (50); | |
442 | if (parport_read_status (port) & PARPORT_STATUS_PAPEROUT) { | |
443 | /* It's buggered. */ | |
444 | parport_frob_control (port, PARPORT_CONTROL_INIT, 0); | |
445 | break; | |
446 | } | |
447 | ||
448 | parport_frob_control (port, PARPORT_CONTROL_INIT, 0); | |
449 | udelay (50); | |
450 | if (!(parport_read_status (port) & PARPORT_STATUS_PAPEROUT)) | |
451 | break; | |
452 | ||
d98ce9fe | 453 | pr_debug("%s: Host transfer recovered\n", port->name); |
1da177e4 LT |
454 | |
455 | if (time_after_eq (jiffies, expire)) break; | |
456 | goto try_again; | |
457 | success: | |
458 | parport_frob_control (port, PARPORT_CONTROL_STROBE, 0); | |
459 | udelay (5); | |
460 | if (parport_wait_peripheral (port, | |
461 | PARPORT_STATUS_BUSY, | |
462 | PARPORT_STATUS_BUSY)) | |
463 | /* Peripheral hasn't accepted the data. */ | |
464 | break; | |
465 | } | |
466 | ||
467 | port->ieee1284.phase = IEEE1284_PH_FWD_IDLE; | |
468 | ||
469 | return written; | |
470 | #endif /* IEEE1284 support */ | |
471 | } | |
472 | ||
473 | /* ECP mode, reverse channel, data. */ | |
474 | size_t parport_ieee1284_ecp_read_data (struct parport *port, | |
475 | void *buffer, size_t len, int flags) | |
476 | { | |
477 | #ifndef CONFIG_PARPORT_1284 | |
478 | return 0; | |
479 | #else | |
480 | struct pardevice *dev = port->cad; | |
481 | unsigned char *buf = buffer; | |
482 | int rle_count = 0; /* shut gcc up */ | |
483 | unsigned char ctl; | |
484 | int rle = 0; | |
485 | ssize_t count = 0; | |
486 | ||
487 | port = port->physport; | |
488 | ||
489 | if (port->ieee1284.phase != IEEE1284_PH_REV_IDLE) | |
490 | if (ecp_forward_to_reverse (port)) | |
491 | return 0; | |
492 | ||
493 | port->ieee1284.phase = IEEE1284_PH_REV_DATA; | |
494 | ||
495 | /* Set HostAck low to start accepting data. */ | |
496 | ctl = parport_read_control (port); | |
497 | ctl &= ~(PARPORT_CONTROL_STROBE | PARPORT_CONTROL_INIT | | |
498 | PARPORT_CONTROL_AUTOFD); | |
499 | parport_write_control (port, | |
500 | ctl | PARPORT_CONTROL_AUTOFD); | |
501 | while (count < len) { | |
502 | unsigned long expire = jiffies + dev->timeout; | |
503 | unsigned char byte; | |
504 | int command; | |
505 | ||
506 | /* Event 43: Peripheral sets nAck low. It can take as | |
507 | long as it wants. */ | |
508 | while (parport_wait_peripheral (port, PARPORT_STATUS_ACK, 0)) { | |
509 | /* The peripheral hasn't given us data in | |
510 | 35ms. If we have data to give back to the | |
511 | caller, do it now. */ | |
512 | if (count) | |
513 | goto out; | |
514 | ||
515 | /* If we've used up all the time we were allowed, | |
516 | give up altogether. */ | |
517 | if (!time_before (jiffies, expire)) | |
518 | goto out; | |
519 | ||
520 | /* Yield the port for a while. */ | |
0be883a0 | 521 | if (dev->port->irq != PARPORT_IRQ_NONE) { |
1da177e4 | 522 | parport_release (dev); |
7b4ccf8d | 523 | schedule_timeout_interruptible(msecs_to_jiffies(40)); |
1da177e4 LT |
524 | parport_claim_or_block (dev); |
525 | } | |
526 | else | |
527 | /* We must have the device claimed here. */ | |
7b4ccf8d | 528 | parport_wait_event (port, msecs_to_jiffies(40)); |
1da177e4 LT |
529 | |
530 | /* Is there a signal pending? */ | |
531 | if (signal_pending (current)) | |
532 | goto out; | |
533 | } | |
534 | ||
535 | /* Is this a command? */ | |
536 | if (rle) | |
537 | /* The last byte was a run-length count, so | |
538 | this can't be as well. */ | |
539 | command = 0; | |
540 | else | |
541 | command = (parport_read_status (port) & | |
542 | PARPORT_STATUS_BUSY) ? 1 : 0; | |
543 | ||
544 | /* Read the data. */ | |
545 | byte = parport_read_data (port); | |
546 | ||
547 | /* If this is a channel command, rather than an RLE | |
548 | command or a normal data byte, don't accept it. */ | |
549 | if (command) { | |
550 | if (byte & 0x80) { | |
d98ce9fe | 551 | pr_debug("%s: stopping short at channel command (%02x)\n", |
1da177e4 LT |
552 | port->name, byte); |
553 | goto out; | |
554 | } | |
555 | else if (port->ieee1284.mode != IEEE1284_MODE_ECPRLE) | |
d98ce9fe | 556 | pr_debug("%s: device illegally using RLE; accepting anyway\n", |
1da177e4 LT |
557 | port->name); |
558 | ||
559 | rle_count = byte + 1; | |
560 | ||
561 | /* Are we allowed to read that many bytes? */ | |
562 | if (rle_count > (len - count)) { | |
d98ce9fe JP |
563 | pr_debug("%s: leaving %d RLE bytes for next time\n", |
564 | port->name, rle_count); | |
1da177e4 LT |
565 | break; |
566 | } | |
567 | ||
568 | rle = 1; | |
569 | } | |
570 | ||
571 | /* Event 44: Set HostAck high, acknowledging handshake. */ | |
572 | parport_write_control (port, ctl); | |
573 | ||
574 | /* Event 45: The peripheral has 35ms to set nAck high. */ | |
575 | if (parport_wait_peripheral (port, PARPORT_STATUS_ACK, | |
576 | PARPORT_STATUS_ACK)) { | |
577 | /* It's gone wrong. Return what data we have | |
578 | to the caller. */ | |
d98ce9fe | 579 | pr_debug("ECP read timed out at 45\n"); |
1da177e4 LT |
580 | |
581 | if (command) | |
decf26f6 | 582 | pr_warn("%s: command ignored (%02x)\n", |
1da177e4 LT |
583 | port->name, byte); |
584 | ||
585 | break; | |
586 | } | |
587 | ||
588 | /* Event 46: Set HostAck low and accept the data. */ | |
589 | parport_write_control (port, | |
590 | ctl | PARPORT_CONTROL_AUTOFD); | |
591 | ||
592 | /* If we just read a run-length count, fetch the data. */ | |
593 | if (command) | |
594 | continue; | |
595 | ||
596 | /* If this is the byte after a run-length count, decompress. */ | |
597 | if (rle) { | |
598 | rle = 0; | |
599 | memset (buf, byte, rle_count); | |
600 | buf += rle_count; | |
601 | count += rle_count; | |
d98ce9fe | 602 | pr_debug("%s: decompressed to %d bytes\n", |
1da177e4 LT |
603 | port->name, rle_count); |
604 | } else { | |
605 | /* Normal data byte. */ | |
606 | *buf = byte; | |
607 | buf++, count++; | |
608 | } | |
609 | } | |
610 | ||
611 | out: | |
612 | port->ieee1284.phase = IEEE1284_PH_REV_IDLE; | |
613 | return count; | |
614 | #endif /* IEEE1284 support */ | |
615 | } | |
616 | ||
617 | /* ECP mode, forward channel, commands. */ | |
618 | size_t parport_ieee1284_ecp_write_addr (struct parport *port, | |
619 | const void *buffer, size_t len, | |
620 | int flags) | |
621 | { | |
622 | #ifndef CONFIG_PARPORT_1284 | |
623 | return 0; | |
624 | #else | |
625 | const unsigned char *buf = buffer; | |
626 | size_t written; | |
627 | int retry; | |
628 | ||
629 | port = port->physport; | |
630 | ||
631 | if (port->ieee1284.phase != IEEE1284_PH_FWD_IDLE) | |
632 | if (ecp_reverse_to_forward (port)) | |
633 | return 0; | |
634 | ||
635 | port->ieee1284.phase = IEEE1284_PH_FWD_DATA; | |
636 | ||
637 | /* HostAck low (command, not data) */ | |
638 | parport_frob_control (port, | |
639 | PARPORT_CONTROL_AUTOFD | |
640 | | PARPORT_CONTROL_STROBE | |
641 | | PARPORT_CONTROL_INIT, | |
642 | PARPORT_CONTROL_AUTOFD | |
643 | | PARPORT_CONTROL_INIT); | |
644 | for (written = 0; written < len; written++, buf++) { | |
645 | unsigned long expire = jiffies + port->cad->timeout; | |
646 | unsigned char byte; | |
647 | ||
648 | byte = *buf; | |
649 | try_again: | |
650 | parport_write_data (port, byte); | |
651 | parport_frob_control (port, PARPORT_CONTROL_STROBE, | |
652 | PARPORT_CONTROL_STROBE); | |
653 | udelay (5); | |
654 | for (retry = 0; retry < 100; retry++) { | |
655 | if (!parport_wait_peripheral (port, | |
656 | PARPORT_STATUS_BUSY, 0)) | |
657 | goto success; | |
658 | ||
659 | if (signal_pending (current)) { | |
660 | parport_frob_control (port, | |
661 | PARPORT_CONTROL_STROBE, | |
662 | 0); | |
663 | break; | |
664 | } | |
665 | } | |
666 | ||
667 | /* Time for Host Transfer Recovery (page 41 of IEEE1284) */ | |
d98ce9fe | 668 | pr_debug("%s: ECP transfer stalled!\n", port->name); |
1da177e4 LT |
669 | |
670 | parport_frob_control (port, PARPORT_CONTROL_INIT, | |
671 | PARPORT_CONTROL_INIT); | |
672 | udelay (50); | |
673 | if (parport_read_status (port) & PARPORT_STATUS_PAPEROUT) { | |
674 | /* It's buggered. */ | |
675 | parport_frob_control (port, PARPORT_CONTROL_INIT, 0); | |
676 | break; | |
677 | } | |
678 | ||
679 | parport_frob_control (port, PARPORT_CONTROL_INIT, 0); | |
680 | udelay (50); | |
681 | if (!(parport_read_status (port) & PARPORT_STATUS_PAPEROUT)) | |
682 | break; | |
683 | ||
d98ce9fe | 684 | pr_debug("%s: Host transfer recovered\n", port->name); |
1da177e4 LT |
685 | |
686 | if (time_after_eq (jiffies, expire)) break; | |
687 | goto try_again; | |
688 | success: | |
689 | parport_frob_control (port, PARPORT_CONTROL_STROBE, 0); | |
690 | udelay (5); | |
691 | if (parport_wait_peripheral (port, | |
692 | PARPORT_STATUS_BUSY, | |
693 | PARPORT_STATUS_BUSY)) | |
694 | /* Peripheral hasn't accepted the data. */ | |
695 | break; | |
696 | } | |
697 | ||
698 | port->ieee1284.phase = IEEE1284_PH_FWD_IDLE; | |
699 | ||
700 | return written; | |
701 | #endif /* IEEE1284 support */ | |
702 | } | |
703 | ||
704 | /*** * | |
705 | * EPP functions. * | |
706 | * ***/ | |
707 | ||
708 | /* EPP mode, forward channel, data. */ | |
709 | size_t parport_ieee1284_epp_write_data (struct parport *port, | |
710 | const void *buffer, size_t len, | |
711 | int flags) | |
712 | { | |
713 | unsigned char *bp = (unsigned char *) buffer; | |
714 | size_t ret = 0; | |
715 | ||
716 | /* set EPP idle state (just to make sure) with strobe low */ | |
717 | parport_frob_control (port, | |
718 | PARPORT_CONTROL_STROBE | | |
719 | PARPORT_CONTROL_AUTOFD | | |
720 | PARPORT_CONTROL_SELECT | | |
721 | PARPORT_CONTROL_INIT, | |
722 | PARPORT_CONTROL_STROBE | | |
723 | PARPORT_CONTROL_INIT); | |
724 | port->ops->data_forward (port); | |
725 | for (; len > 0; len--, bp++) { | |
726 | /* Event 62: Write data and set autofd low */ | |
727 | parport_write_data (port, *bp); | |
728 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, | |
729 | PARPORT_CONTROL_AUTOFD); | |
730 | ||
731 | /* Event 58: wait for busy (nWait) to go high */ | |
732 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, 0, 10)) | |
733 | break; | |
734 | ||
735 | /* Event 63: set nAutoFd (nDStrb) high */ | |
736 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0); | |
737 | ||
738 | /* Event 60: wait for busy (nWait) to go low */ | |
739 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, | |
740 | PARPORT_STATUS_BUSY, 5)) | |
741 | break; | |
742 | ||
743 | ret++; | |
744 | } | |
745 | ||
746 | /* Event 61: set strobe (nWrite) high */ | |
747 | parport_frob_control (port, PARPORT_CONTROL_STROBE, 0); | |
748 | ||
749 | return ret; | |
750 | } | |
751 | ||
752 | /* EPP mode, reverse channel, data. */ | |
753 | size_t parport_ieee1284_epp_read_data (struct parport *port, | |
754 | void *buffer, size_t len, | |
755 | int flags) | |
756 | { | |
757 | unsigned char *bp = (unsigned char *) buffer; | |
758 | unsigned ret = 0; | |
759 | ||
760 | /* set EPP idle state (just to make sure) with strobe high */ | |
761 | parport_frob_control (port, | |
762 | PARPORT_CONTROL_STROBE | | |
763 | PARPORT_CONTROL_AUTOFD | | |
764 | PARPORT_CONTROL_SELECT | | |
765 | PARPORT_CONTROL_INIT, | |
766 | PARPORT_CONTROL_INIT); | |
767 | port->ops->data_reverse (port); | |
768 | for (; len > 0; len--, bp++) { | |
769 | /* Event 67: set nAutoFd (nDStrb) low */ | |
770 | parport_frob_control (port, | |
771 | PARPORT_CONTROL_AUTOFD, | |
772 | PARPORT_CONTROL_AUTOFD); | |
773 | /* Event 58: wait for Busy to go high */ | |
774 | if (parport_wait_peripheral (port, PARPORT_STATUS_BUSY, 0)) { | |
775 | break; | |
776 | } | |
777 | ||
778 | *bp = parport_read_data (port); | |
779 | ||
780 | /* Event 63: set nAutoFd (nDStrb) high */ | |
781 | parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0); | |
782 | ||
783 | /* Event 60: wait for Busy to go low */ | |
784 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, | |
785 | PARPORT_STATUS_BUSY, 5)) { | |
786 | break; | |
787 | } | |
788 | ||
789 | ret++; | |
790 | } | |
791 | port->ops->data_forward (port); | |
792 | ||
793 | return ret; | |
794 | } | |
795 | ||
796 | /* EPP mode, forward channel, addresses. */ | |
797 | size_t parport_ieee1284_epp_write_addr (struct parport *port, | |
798 | const void *buffer, size_t len, | |
799 | int flags) | |
800 | { | |
801 | unsigned char *bp = (unsigned char *) buffer; | |
802 | size_t ret = 0; | |
803 | ||
804 | /* set EPP idle state (just to make sure) with strobe low */ | |
805 | parport_frob_control (port, | |
806 | PARPORT_CONTROL_STROBE | | |
807 | PARPORT_CONTROL_AUTOFD | | |
808 | PARPORT_CONTROL_SELECT | | |
809 | PARPORT_CONTROL_INIT, | |
810 | PARPORT_CONTROL_STROBE | | |
811 | PARPORT_CONTROL_INIT); | |
812 | port->ops->data_forward (port); | |
813 | for (; len > 0; len--, bp++) { | |
814 | /* Event 56: Write data and set nAStrb low. */ | |
815 | parport_write_data (port, *bp); | |
816 | parport_frob_control (port, PARPORT_CONTROL_SELECT, | |
817 | PARPORT_CONTROL_SELECT); | |
818 | ||
819 | /* Event 58: wait for busy (nWait) to go high */ | |
820 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, 0, 10)) | |
821 | break; | |
822 | ||
823 | /* Event 59: set nAStrb high */ | |
824 | parport_frob_control (port, PARPORT_CONTROL_SELECT, 0); | |
825 | ||
826 | /* Event 60: wait for busy (nWait) to go low */ | |
827 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, | |
828 | PARPORT_STATUS_BUSY, 5)) | |
829 | break; | |
830 | ||
831 | ret++; | |
832 | } | |
833 | ||
834 | /* Event 61: set strobe (nWrite) high */ | |
835 | parport_frob_control (port, PARPORT_CONTROL_STROBE, 0); | |
836 | ||
837 | return ret; | |
838 | } | |
839 | ||
840 | /* EPP mode, reverse channel, addresses. */ | |
841 | size_t parport_ieee1284_epp_read_addr (struct parport *port, | |
842 | void *buffer, size_t len, | |
843 | int flags) | |
844 | { | |
845 | unsigned char *bp = (unsigned char *) buffer; | |
846 | unsigned ret = 0; | |
847 | ||
848 | /* Set EPP idle state (just to make sure) with strobe high */ | |
849 | parport_frob_control (port, | |
850 | PARPORT_CONTROL_STROBE | | |
851 | PARPORT_CONTROL_AUTOFD | | |
852 | PARPORT_CONTROL_SELECT | | |
853 | PARPORT_CONTROL_INIT, | |
854 | PARPORT_CONTROL_INIT); | |
855 | port->ops->data_reverse (port); | |
856 | for (; len > 0; len--, bp++) { | |
857 | /* Event 64: set nSelectIn (nAStrb) low */ | |
858 | parport_frob_control (port, PARPORT_CONTROL_SELECT, | |
859 | PARPORT_CONTROL_SELECT); | |
860 | ||
861 | /* Event 58: wait for Busy to go high */ | |
862 | if (parport_wait_peripheral (port, PARPORT_STATUS_BUSY, 0)) { | |
863 | break; | |
864 | } | |
865 | ||
866 | *bp = parport_read_data (port); | |
867 | ||
868 | /* Event 59: set nSelectIn (nAStrb) high */ | |
869 | parport_frob_control (port, PARPORT_CONTROL_SELECT, | |
13050d89 | 870 | 0); |
1da177e4 LT |
871 | |
872 | /* Event 60: wait for Busy to go low */ | |
873 | if (parport_poll_peripheral (port, PARPORT_STATUS_BUSY, | |
874 | PARPORT_STATUS_BUSY, 5)) | |
875 | break; | |
876 | ||
877 | ret++; | |
878 | } | |
879 | port->ops->data_forward (port); | |
880 | ||
881 | return ret; | |
882 | } | |
883 | ||
884 | EXPORT_SYMBOL(parport_ieee1284_ecp_write_data); | |
885 | EXPORT_SYMBOL(parport_ieee1284_ecp_read_data); | |
886 | EXPORT_SYMBOL(parport_ieee1284_ecp_write_addr); | |
887 | EXPORT_SYMBOL(parport_ieee1284_write_compat); | |
888 | EXPORT_SYMBOL(parport_ieee1284_read_nibble); | |
889 | EXPORT_SYMBOL(parport_ieee1284_read_byte); | |
890 | EXPORT_SYMBOL(parport_ieee1284_epp_write_data); | |
891 | EXPORT_SYMBOL(parport_ieee1284_epp_read_data); | |
892 | EXPORT_SYMBOL(parport_ieee1284_epp_write_addr); | |
893 | EXPORT_SYMBOL(parport_ieee1284_epp_read_addr); |