atppc.c revision 1.26 1 1.26 cegger /* $NetBSD: atppc.c,v 1.26 2008/04/15 15:02:28 cegger Exp $ */
2 1.3 bjh21
3 1.1 jdolecek /*
4 1.1 jdolecek * Copyright (c) 2001 Alcove - Nicolas Souchu
5 1.13 jdolecek * Copyright (c) 2003, 2004 Gary Thorpe <gathorpe (at) users.sourceforge.net>
6 1.1 jdolecek * All rights reserved.
7 1.1 jdolecek *
8 1.1 jdolecek * Redistribution and use in source and binary forms, with or without
9 1.1 jdolecek * modification, are permitted provided that the following conditions
10 1.1 jdolecek * are met:
11 1.1 jdolecek * 1. Redistributions of source code must retain the above copyright
12 1.1 jdolecek * notice, this list of conditions and the following disclaimer.
13 1.1 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 jdolecek * notice, this list of conditions and the following disclaimer in the
15 1.1 jdolecek * documentation and/or other materials provided with the distribution.
16 1.1 jdolecek *
17 1.1 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 1.1 jdolecek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 1.1 jdolecek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 1.1 jdolecek * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 1.1 jdolecek * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 1.1 jdolecek * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 1.1 jdolecek * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 1.1 jdolecek * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 1.1 jdolecek * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 1.1 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 1.1 jdolecek * SUCH DAMAGE.
28 1.1 jdolecek *
29 1.7 bjh21 * FreeBSD: src/sys/isa/ppc.c,v 1.26.2.5 2001/10/02 05:21:45 nsouch Exp
30 1.1 jdolecek *
31 1.1 jdolecek */
32 1.1 jdolecek
33 1.7 bjh21 #include <sys/cdefs.h>
34 1.26 cegger __KERNEL_RCSID(0, "$NetBSD: atppc.c,v 1.26 2008/04/15 15:02:28 cegger Exp $");
35 1.7 bjh21
36 1.1 jdolecek #include "opt_atppc.h"
37 1.1 jdolecek
38 1.1 jdolecek #include <sys/types.h>
39 1.1 jdolecek #include <sys/param.h>
40 1.1 jdolecek #include <sys/kernel.h>
41 1.1 jdolecek #include <sys/device.h>
42 1.1 jdolecek #include <sys/malloc.h>
43 1.1 jdolecek #include <sys/proc.h>
44 1.1 jdolecek #include <sys/systm.h>
45 1.1 jdolecek #include <sys/vnode.h>
46 1.1 jdolecek #include <sys/syslog.h>
47 1.1 jdolecek
48 1.24 ad #include <sys/bus.h>
49 1.24 ad /*#include <sys/intr.h>*/
50 1.1 jdolecek
51 1.1 jdolecek #include <dev/isa/isareg.h>
52 1.1 jdolecek
53 1.1 jdolecek #include <dev/ic/atppcreg.h>
54 1.1 jdolecek #include <dev/ic/atppcvar.h>
55 1.1 jdolecek
56 1.1 jdolecek #include <dev/ppbus/ppbus_conf.h>
57 1.1 jdolecek #include <dev/ppbus/ppbus_msq.h>
58 1.1 jdolecek #include <dev/ppbus/ppbus_io.h>
59 1.1 jdolecek #include <dev/ppbus/ppbus_var.h>
60 1.1 jdolecek
61 1.1 jdolecek #ifdef ATPPC_DEBUG
62 1.1 jdolecek int atppc_debug = 1;
63 1.1 jdolecek #endif
64 1.1 jdolecek
65 1.1 jdolecek #ifdef ATPPC_VERBOSE
66 1.1 jdolecek int atppc_verbose = 1;
67 1.1 jdolecek #endif
68 1.1 jdolecek
69 1.1 jdolecek /* List of supported chipsets detection routines */
70 1.1 jdolecek static int (*chipset_detect[])(struct atppc_softc *) = {
71 1.22 wiz /* XXX Add these LATER: maybe as separate devices?
72 1.1 jdolecek atppc_pc873xx_detect,
73 1.1 jdolecek atppc_smc37c66xgt_detect,
74 1.1 jdolecek atppc_w83877f_detect,
75 1.1 jdolecek atppc_smc37c935_detect,
76 1.1 jdolecek */
77 1.1 jdolecek NULL
78 1.1 jdolecek };
79 1.1 jdolecek
80 1.9 drochner
81 1.1 jdolecek /* Prototypes for functions. */
82 1.1 jdolecek
83 1.18 drochner /* Print function for config_found() */
84 1.9 drochner static int atppc_print(void *, const char *);
85 1.15 drochner
86 1.1 jdolecek /* Detection routines */
87 1.1 jdolecek static int atppc_detect_fifo(struct atppc_softc *);
88 1.1 jdolecek static int atppc_detect_chipset(struct atppc_softc *);
89 1.1 jdolecek static int atppc_detect_generic(struct atppc_softc *);
90 1.1 jdolecek
91 1.1 jdolecek /* Routines for ppbus interface (bus + device) */
92 1.26 cegger static int atppc_read(device_t, char *, int, int, size_t *);
93 1.26 cegger static int atppc_write(device_t, char *, int, int, size_t *);
94 1.26 cegger static int atppc_setmode(device_t, int);
95 1.26 cegger static int atppc_getmode(device_t);
96 1.26 cegger static int atppc_check_epp_timeout(device_t);
97 1.26 cegger static void atppc_reset_epp_timeout(device_t);
98 1.26 cegger static void atppc_ecp_sync(device_t);
99 1.26 cegger static int atppc_exec_microseq(device_t, struct ppbus_microseq * *);
100 1.26 cegger static u_int8_t atppc_io(device_t, int, u_char *, int, u_char);
101 1.26 cegger static int atppc_read_ivar(device_t, int, unsigned int *);
102 1.26 cegger static int atppc_write_ivar(device_t, int, unsigned int *);
103 1.26 cegger static int atppc_add_handler(device_t, void (*)(void *), void *);
104 1.26 cegger static int atppc_remove_handler(device_t, void (*)(void *));
105 1.1 jdolecek
106 1.1 jdolecek /* Utility functions */
107 1.1 jdolecek
108 1.1 jdolecek /* Functions to read bytes into device's input buffer */
109 1.1 jdolecek static void atppc_nibble_read(struct atppc_softc * const);
110 1.1 jdolecek static void atppc_byte_read(struct atppc_softc * const);
111 1.1 jdolecek static void atppc_epp_read(struct atppc_softc * const);
112 1.1 jdolecek static void atppc_ecp_read(struct atppc_softc * const);
113 1.9 drochner static void atppc_ecp_read_dma(struct atppc_softc *, unsigned int *,
114 1.1 jdolecek unsigned char);
115 1.9 drochner static void atppc_ecp_read_pio(struct atppc_softc *, unsigned int *,
116 1.1 jdolecek unsigned char);
117 1.21 drochner static void atppc_ecp_read_error(struct atppc_softc *);
118 1.1 jdolecek
119 1.1 jdolecek
120 1.1 jdolecek /* Functions to write bytes to device's output buffer */
121 1.1 jdolecek static void atppc_std_write(struct atppc_softc * const);
122 1.1 jdolecek static void atppc_epp_write(struct atppc_softc * const);
123 1.1 jdolecek static void atppc_fifo_write(struct atppc_softc * const);
124 1.9 drochner static void atppc_fifo_write_dma(struct atppc_softc * const, unsigned char,
125 1.1 jdolecek unsigned char);
126 1.1 jdolecek static void atppc_fifo_write_pio(struct atppc_softc * const, unsigned char,
127 1.1 jdolecek unsigned char);
128 1.9 drochner static void atppc_fifo_write_error(struct atppc_softc * const,
129 1.1 jdolecek const unsigned int);
130 1.1 jdolecek
131 1.1 jdolecek /* Miscellaneous */
132 1.9 drochner static int atppc_poll_str(const struct atppc_softc * const, const u_int8_t,
133 1.1 jdolecek const u_int8_t);
134 1.23 christos static int atppc_wait_interrupt(struct atppc_softc * const, const void *,
135 1.1 jdolecek const u_int8_t);
136 1.1 jdolecek
137 1.1 jdolecek
138 1.1 jdolecek /*
139 1.9 drochner * Generic attach and detach functions for atppc device. If sc_dev_ok in soft
140 1.1 jdolecek * configuration data is not ATPPC_ATTACHED, these should be skipped altogether.
141 1.1 jdolecek */
142 1.1 jdolecek
143 1.1 jdolecek /* Soft configuration attach for atppc */
144 1.1 jdolecek void
145 1.9 drochner atppc_sc_attach(struct atppc_softc *lsc)
146 1.1 jdolecek {
147 1.1 jdolecek /* Adapter used to configure ppbus device */
148 1.1 jdolecek struct parport_adapter sc_parport_adapter;
149 1.1 jdolecek char buf[64];
150 1.1 jdolecek
151 1.16 drochner ATPPC_LOCK_INIT(lsc);
152 1.16 drochner
153 1.1 jdolecek /* Probe and set up chipset */
154 1.9 drochner if (atppc_detect_chipset(lsc) != 0) {
155 1.9 drochner if (atppc_detect_generic(lsc) != 0) {
156 1.9 drochner ATPPC_DPRINTF(("%s: Error detecting chipset\n",
157 1.26 cegger device_xname(lsc->sc_dev)));
158 1.1 jdolecek }
159 1.1 jdolecek }
160 1.1 jdolecek
161 1.1 jdolecek /* Probe and setup FIFO queue */
162 1.8 jdolecek if (atppc_detect_fifo(lsc) == 0) {
163 1.9 drochner printf("%s: FIFO <depth,wthr,rthr>=<%d,%d,%d>\n",
164 1.26 cegger device_xname(lsc->sc_dev), lsc->sc_fifo, lsc->sc_wthr,
165 1.8 jdolecek lsc->sc_rthr);
166 1.1 jdolecek }
167 1.1 jdolecek
168 1.1 jdolecek /* Print out chipset capabilities */
169 1.1 jdolecek bitmask_snprintf(lsc->sc_has, "\20\1INTR\2DMA\3FIFO\4PS2\5ECP\6EPP",
170 1.9 drochner buf, sizeof(buf));
171 1.26 cegger printf("%s: capabilities=%s\n", device_xname(lsc->sc_dev), buf);
172 1.1 jdolecek
173 1.1 jdolecek /* Initialize device's buffer pointers */
174 1.9 drochner lsc->sc_outb = lsc->sc_outbstart = lsc->sc_inb = lsc->sc_inbstart
175 1.1 jdolecek = NULL;
176 1.1 jdolecek lsc->sc_inb_nbytes = lsc->sc_outb_nbytes = 0;
177 1.1 jdolecek
178 1.1 jdolecek /* Last configuration step: set mode to standard mode */
179 1.26 cegger if (atppc_setmode(lsc->sc_dev, PPBUS_COMPATIBLE) != 0) {
180 1.9 drochner ATPPC_DPRINTF(("%s: unable to initialize mode.\n",
181 1.26 cegger device_xname(lsc->sc_dev)));
182 1.1 jdolecek }
183 1.1 jdolecek
184 1.1 jdolecek #if defined (MULTIPROCESSOR) || defined (LOCKDEBUG)
185 1.1 jdolecek /* Initialize lock structure */
186 1.1 jdolecek simple_lock_init(&(lsc->sc_lock));
187 1.1 jdolecek #endif
188 1.1 jdolecek
189 1.1 jdolecek /* Set up parport_adapter structure */
190 1.15 drochner
191 1.1 jdolecek /* Set capabilites */
192 1.1 jdolecek sc_parport_adapter.capabilities = 0;
193 1.9 drochner if (lsc->sc_has & ATPPC_HAS_INTR) {
194 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_INTR;
195 1.1 jdolecek }
196 1.9 drochner if (lsc->sc_has & ATPPC_HAS_DMA) {
197 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_DMA;
198 1.1 jdolecek }
199 1.9 drochner if (lsc->sc_has & ATPPC_HAS_FIFO) {
200 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_FIFO;
201 1.1 jdolecek }
202 1.9 drochner if (lsc->sc_has & ATPPC_HAS_PS2) {
203 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_PS2;
204 1.1 jdolecek }
205 1.9 drochner if (lsc->sc_has & ATPPC_HAS_EPP) {
206 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_EPP;
207 1.1 jdolecek }
208 1.9 drochner if (lsc->sc_has & ATPPC_HAS_ECP) {
209 1.1 jdolecek sc_parport_adapter.capabilities |= PPBUS_HAS_ECP;
210 1.1 jdolecek }
211 1.1 jdolecek
212 1.1 jdolecek /* Set function pointers */
213 1.1 jdolecek sc_parport_adapter.parport_io = atppc_io;
214 1.1 jdolecek sc_parport_adapter.parport_exec_microseq = atppc_exec_microseq;
215 1.9 drochner sc_parport_adapter.parport_reset_epp_timeout =
216 1.1 jdolecek atppc_reset_epp_timeout;
217 1.1 jdolecek sc_parport_adapter.parport_setmode = atppc_setmode;
218 1.1 jdolecek sc_parport_adapter.parport_getmode = atppc_getmode;
219 1.1 jdolecek sc_parport_adapter.parport_ecp_sync = atppc_ecp_sync;
220 1.1 jdolecek sc_parport_adapter.parport_read = atppc_read;
221 1.1 jdolecek sc_parport_adapter.parport_write = atppc_write;
222 1.1 jdolecek sc_parport_adapter.parport_read_ivar = atppc_read_ivar;
223 1.1 jdolecek sc_parport_adapter.parport_write_ivar = atppc_write_ivar;
224 1.1 jdolecek sc_parport_adapter.parport_dma_malloc = lsc->sc_dma_malloc;
225 1.1 jdolecek sc_parport_adapter.parport_dma_free = lsc->sc_dma_free;
226 1.1 jdolecek sc_parport_adapter.parport_add_handler = atppc_add_handler;
227 1.1 jdolecek sc_parport_adapter.parport_remove_handler = atppc_remove_handler;
228 1.1 jdolecek
229 1.1 jdolecek /* Initialize handler list, may be added to by grandchildren */
230 1.1 jdolecek SLIST_INIT(&(lsc->sc_handler_listhead));
231 1.15 drochner
232 1.1 jdolecek /* Initialize interrupt state */
233 1.1 jdolecek lsc->sc_irqstat = ATPPC_IRQ_NONE;
234 1.1 jdolecek lsc->sc_ecr_intr = lsc->sc_ctr_intr = lsc->sc_str_intr = 0;
235 1.1 jdolecek
236 1.1 jdolecek /* Disable DMA/interrupts (each ppbus driver selects usage itself) */
237 1.1 jdolecek lsc->sc_use = 0;
238 1.1 jdolecek
239 1.9 drochner /* Configure child of the device. */
240 1.26 cegger lsc->child = config_found(lsc->sc_dev, &(sc_parport_adapter),
241 1.18 drochner atppc_print);
242 1.1 jdolecek
243 1.1 jdolecek return;
244 1.1 jdolecek }
245 1.1 jdolecek
246 1.1 jdolecek /* Soft configuration detach */
247 1.17 thorpej int
248 1.17 thorpej atppc_sc_detach(struct atppc_softc *lsc, int flag)
249 1.1 jdolecek {
250 1.26 cegger device_t dev = lsc->sc_dev;
251 1.1 jdolecek
252 1.1 jdolecek /* Detach children devices */
253 1.9 drochner if (config_detach(lsc->child, flag) && !(flag & DETACH_QUIET)) {
254 1.25 cegger aprint_error_dev(dev, "not able to detach child device, ");
255 1.1 jdolecek
256 1.9 drochner if (!(flag & DETACH_FORCE)) {
257 1.2 jdolecek printf("cannot detach\n");
258 1.1 jdolecek return 1;
259 1.9 drochner } else {
260 1.2 jdolecek printf("continuing (DETACH_FORCE)\n");
261 1.1 jdolecek }
262 1.1 jdolecek }
263 1.1 jdolecek
264 1.9 drochner if (!(flag & DETACH_QUIET))
265 1.25 cegger printf("%s detached", device_xname(dev));
266 1.15 drochner
267 1.1 jdolecek return 0;
268 1.1 jdolecek }
269 1.1 jdolecek
270 1.18 drochner /* Used by config_found() to print out device information */
271 1.9 drochner static int
272 1.9 drochner atppc_print(void *aux, const char *name)
273 1.1 jdolecek {
274 1.1 jdolecek /* Print out something on failure. */
275 1.9 drochner if (name != NULL) {
276 1.1 jdolecek printf("%s: child devices", name);
277 1.1 jdolecek return UNCONF;
278 1.1 jdolecek }
279 1.1 jdolecek
280 1.1 jdolecek return QUIET;
281 1.1 jdolecek }
282 1.1 jdolecek
283 1.1 jdolecek /*
284 1.1 jdolecek * Machine independent detection routines for atppc driver.
285 1.1 jdolecek */
286 1.1 jdolecek
287 1.1 jdolecek /* Detect parallel port I/O port: taken from FreeBSD code directly. */
288 1.1 jdolecek int
289 1.1 jdolecek atppc_detect_port(bus_space_tag_t iot, bus_space_handle_t ioh)
290 1.1 jdolecek {
291 1.9 drochner /*
292 1.9 drochner * Much shorter than scheme used by lpt_isa_probe() and lpt_port_test()
293 1.9 drochner * in original lpt driver.
294 1.9 drochner * Write to data register common to all controllers and read back the
295 1.1 jdolecek * values. Also tests control and status registers.
296 1.1 jdolecek */
297 1.1 jdolecek
298 1.1 jdolecek /*
299 1.9 drochner * Cannot use convenient macros because the device's config structure
300 1.1 jdolecek * may not have been created yet: major change from FreeBSD code.
301 1.1 jdolecek */
302 1.1 jdolecek
303 1.1 jdolecek int rval;
304 1.1 jdolecek u_int8_t ctr_sav, dtr_sav, str_sav;
305 1.1 jdolecek
306 1.1 jdolecek /* Store writtable registers' values and test if they can be read */
307 1.1 jdolecek str_sav = bus_space_read_1(iot, ioh, ATPPC_SPP_STR);
308 1.1 jdolecek ctr_sav = bus_space_read_1(iot, ioh, ATPPC_SPP_CTR);
309 1.1 jdolecek dtr_sav = bus_space_read_1(iot, ioh, ATPPC_SPP_DTR);
310 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
311 1.9 drochner BUS_SPACE_BARRIER_READ);
312 1.1 jdolecek
313 1.9 drochner /*
314 1.9 drochner * Ensure PS2 ports in output mode, also read back value of control
315 1.9 drochner * register.
316 1.1 jdolecek */
317 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_CTR, 0x0c);
318 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
319 1.9 drochner BUS_SPACE_BARRIER_WRITE);
320 1.15 drochner
321 1.9 drochner if (bus_space_read_1(iot, ioh, ATPPC_SPP_CTR) != 0x0c) {
322 1.1 jdolecek rval = 0;
323 1.9 drochner } else {
324 1.9 drochner /*
325 1.9 drochner * Test if two values can be written and read from the data
326 1.9 drochner * register.
327 1.1 jdolecek */
328 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
329 1.9 drochner BUS_SPACE_BARRIER_READ);
330 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_DTR, 0xaa);
331 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
332 1.9 drochner BUS_SPACE_BARRIER_WRITE);
333 1.1 jdolecek if (bus_space_read_1(iot, ioh, ATPPC_SPP_DTR) != 0xaa) {
334 1.1 jdolecek rval = 1;
335 1.9 drochner } else {
336 1.1 jdolecek /* Second value to test */
337 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
338 1.9 drochner BUS_SPACE_BARRIER_READ);
339 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_DTR, 0x55);
340 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
341 1.9 drochner BUS_SPACE_BARRIER_WRITE);
342 1.9 drochner if (bus_space_read_1(iot, ioh, ATPPC_SPP_DTR) != 0x55) {
343 1.1 jdolecek rval = 1;
344 1.9 drochner } else {
345 1.1 jdolecek rval = 0;
346 1.1 jdolecek }
347 1.1 jdolecek }
348 1.15 drochner
349 1.1 jdolecek }
350 1.15 drochner
351 1.1 jdolecek /* Restore registers */
352 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
353 1.9 drochner BUS_SPACE_BARRIER_READ);
354 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_CTR, ctr_sav);
355 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_DTR, dtr_sav);
356 1.1 jdolecek bus_space_write_1(iot, ioh, ATPPC_SPP_STR, str_sav);
357 1.9 drochner bus_space_barrier(iot, ioh, 0, IO_LPTSIZE,
358 1.9 drochner BUS_SPACE_BARRIER_WRITE);
359 1.1 jdolecek
360 1.1 jdolecek return rval;
361 1.1 jdolecek }
362 1.1 jdolecek
363 1.1 jdolecek /* Detect parallel port chipset. */
364 1.1 jdolecek static int
365 1.9 drochner atppc_detect_chipset(struct atppc_softc *atppc)
366 1.1 jdolecek {
367 1.1 jdolecek /* Try each detection routine. */
368 1.1 jdolecek int i, mode;
369 1.1 jdolecek for (i = 0; chipset_detect[i] != NULL; i++) {
370 1.1 jdolecek if ((mode = chipset_detect[i](atppc)) != -1) {
371 1.1 jdolecek atppc->sc_mode = mode;
372 1.1 jdolecek return 0;
373 1.1 jdolecek }
374 1.1 jdolecek }
375 1.1 jdolecek
376 1.1 jdolecek return 1;
377 1.1 jdolecek }
378 1.1 jdolecek
379 1.1 jdolecek /* Detect generic capabilities. */
380 1.9 drochner static int
381 1.9 drochner atppc_detect_generic(struct atppc_softc *atppc)
382 1.1 jdolecek {
383 1.1 jdolecek u_int8_t ecr_sav = atppc_r_ecr(atppc);
384 1.1 jdolecek u_int8_t ctr_sav = atppc_r_ctr(atppc);
385 1.1 jdolecek u_int8_t str_sav = atppc_r_str(atppc);
386 1.9 drochner u_int8_t tmp;
387 1.1 jdolecek atppc_barrier_r(atppc);
388 1.1 jdolecek
389 1.1 jdolecek /* Default to generic */
390 1.1 jdolecek atppc->sc_type = ATPPC_TYPE_GENERIC;
391 1.1 jdolecek atppc->sc_model = GENERIC;
392 1.1 jdolecek
393 1.1 jdolecek /* Check for ECP */
394 1.1 jdolecek tmp = atppc_r_ecr(atppc);
395 1.1 jdolecek atppc_barrier_r(atppc);
396 1.1 jdolecek if ((tmp & ATPPC_FIFO_EMPTY) && !(tmp & ATPPC_FIFO_FULL)) {
397 1.1 jdolecek atppc_w_ecr(atppc, 0x34);
398 1.1 jdolecek atppc_barrier_w(atppc);
399 1.1 jdolecek tmp = atppc_r_ecr(atppc);
400 1.1 jdolecek atppc_barrier_r(atppc);
401 1.9 drochner if (tmp == 0x35) {
402 1.1 jdolecek atppc->sc_has |= ATPPC_HAS_ECP;
403 1.1 jdolecek }
404 1.1 jdolecek }
405 1.1 jdolecek
406 1.1 jdolecek /* Allow search for SMC style ECP+EPP mode */
407 1.9 drochner if (atppc->sc_has & ATPPC_HAS_ECP) {
408 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_EPP);
409 1.1 jdolecek atppc_barrier_w(atppc);
410 1.1 jdolecek }
411 1.1 jdolecek /* Check for EPP by checking for timeout bit */
412 1.26 cegger if (atppc_check_epp_timeout(atppc->sc_dev) != 0) {
413 1.1 jdolecek atppc->sc_has |= ATPPC_HAS_EPP;
414 1.1 jdolecek atppc->sc_epp = ATPPC_EPP_1_9;
415 1.9 drochner if (atppc->sc_has & ATPPC_HAS_ECP) {
416 1.1 jdolecek /* SMC like chipset found */
417 1.1 jdolecek atppc->sc_model = SMC_LIKE;
418 1.1 jdolecek atppc->sc_type = ATPPC_TYPE_SMCLIKE;
419 1.1 jdolecek }
420 1.1 jdolecek }
421 1.1 jdolecek
422 1.1 jdolecek /* Detect PS2 mode */
423 1.9 drochner if (atppc->sc_has & ATPPC_HAS_ECP) {
424 1.1 jdolecek /* Put ECP port into PS2 mode */
425 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
426 1.1 jdolecek atppc_barrier_w(atppc);
427 1.1 jdolecek }
428 1.1 jdolecek /* Put PS2 port in input mode: writes should not be readable */
429 1.1 jdolecek atppc_w_ctr(atppc, 0x20);
430 1.1 jdolecek atppc_barrier_w(atppc);
431 1.9 drochner /*
432 1.9 drochner * Write two values to data port: if neither are read back,
433 1.1 jdolecek * bidirectional mode is functional.
434 1.1 jdolecek */
435 1.1 jdolecek atppc_w_dtr(atppc, 0xaa);
436 1.1 jdolecek atppc_barrier_w(atppc);
437 1.1 jdolecek tmp = atppc_r_dtr(atppc);
438 1.1 jdolecek atppc_barrier_r(atppc);
439 1.15 drochner if (tmp != 0xaa) {
440 1.1 jdolecek atppc_w_dtr(atppc, 0x55);
441 1.1 jdolecek atppc_barrier_w(atppc);
442 1.1 jdolecek tmp = atppc_r_dtr(atppc);
443 1.1 jdolecek atppc_barrier_r(atppc);
444 1.9 drochner if (tmp != 0x55) {
445 1.1 jdolecek atppc->sc_has |= ATPPC_HAS_PS2;
446 1.1 jdolecek }
447 1.1 jdolecek }
448 1.15 drochner
449 1.1 jdolecek /* Restore to previous state */
450 1.1 jdolecek atppc_w_ecr(atppc, ecr_sav);
451 1.1 jdolecek atppc_w_ctr(atppc, ctr_sav);
452 1.1 jdolecek atppc_w_str(atppc, str_sav);
453 1.1 jdolecek atppc_barrier_w(atppc);
454 1.1 jdolecek
455 1.1 jdolecek return 0;
456 1.1 jdolecek }
457 1.1 jdolecek
458 1.9 drochner /*
459 1.9 drochner * Detect parallel port FIFO: taken from FreeBSD code directly.
460 1.1 jdolecek */
461 1.1 jdolecek static int
462 1.9 drochner atppc_detect_fifo(struct atppc_softc *atppc)
463 1.1 jdolecek {
464 1.1 jdolecek #ifdef ATPPC_DEBUG
465 1.26 cegger device_t dev = atppc->sc_dev;
466 1.1 jdolecek #endif
467 1.1 jdolecek u_int8_t ecr_sav;
468 1.1 jdolecek u_int8_t ctr_sav;
469 1.1 jdolecek u_int8_t str_sav;
470 1.1 jdolecek u_int8_t cc;
471 1.1 jdolecek short i;
472 1.1 jdolecek
473 1.1 jdolecek /* If there is no ECP mode, we cannot config a FIFO */
474 1.9 drochner if (!(atppc->sc_has & ATPPC_HAS_ECP)) {
475 1.1 jdolecek return (EINVAL);
476 1.1 jdolecek }
477 1.1 jdolecek
478 1.1 jdolecek /* save registers */
479 1.1 jdolecek ecr_sav = atppc_r_ecr(atppc);
480 1.1 jdolecek ctr_sav = atppc_r_ctr(atppc);
481 1.1 jdolecek str_sav = atppc_r_str(atppc);
482 1.1 jdolecek atppc_barrier_r(atppc);
483 1.15 drochner
484 1.1 jdolecek /* Enter ECP configuration mode, no interrupt, no DMA */
485 1.9 drochner atppc_w_ecr(atppc, (ATPPC_ECR_CFG | ATPPC_SERVICE_INTR) &
486 1.1 jdolecek ~ATPPC_ENABLE_DMA);
487 1.1 jdolecek atppc_barrier_w(atppc);
488 1.1 jdolecek
489 1.1 jdolecek /* read PWord size - transfers in FIFO mode must be PWord aligned */
490 1.1 jdolecek atppc->sc_pword = (atppc_r_cnfgA(atppc) & ATPPC_PWORD_MASK);
491 1.1 jdolecek atppc_barrier_r(atppc);
492 1.1 jdolecek
493 1.1 jdolecek /* XXX 16 and 32 bits implementations not supported */
494 1.9 drochner if (atppc->sc_pword != ATPPC_PWORD_8) {
495 1.9 drochner ATPPC_DPRINTF(("%s(%s): FIFO PWord(%d) not supported.\n",
496 1.25 cegger __func__, device_xname(dev), atppc->sc_pword));
497 1.1 jdolecek goto error;
498 1.1 jdolecek }
499 1.1 jdolecek
500 1.1 jdolecek /* Byte mode, reverse direction, no interrupt, no DMA */
501 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2 | ATPPC_SERVICE_INTR);
502 1.1 jdolecek atppc_w_ctr(atppc, (ctr_sav & ~IRQENABLE) | PCD);
503 1.1 jdolecek /* enter ECP test mode, no interrupt, no DMA */
504 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_TST | ATPPC_SERVICE_INTR);
505 1.1 jdolecek atppc_barrier_w(atppc);
506 1.1 jdolecek
507 1.1 jdolecek /* flush the FIFO */
508 1.1 jdolecek for (i = 0; i < 1024; i++) {
509 1.1 jdolecek atppc_r_fifo(atppc);
510 1.1 jdolecek atppc_barrier_r(atppc);
511 1.1 jdolecek cc = atppc_r_ecr(atppc);
512 1.1 jdolecek atppc_barrier_r(atppc);
513 1.9 drochner if (cc & ATPPC_FIFO_EMPTY)
514 1.1 jdolecek break;
515 1.1 jdolecek }
516 1.1 jdolecek if (i >= 1024) {
517 1.9 drochner ATPPC_DPRINTF(("%s(%s): cannot flush FIFO.\n", __func__,
518 1.25 cegger device_xname(dev)));
519 1.1 jdolecek goto error;
520 1.1 jdolecek }
521 1.1 jdolecek
522 1.1 jdolecek /* Test mode, enable interrupts, no DMA */
523 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_TST);
524 1.1 jdolecek atppc_barrier_w(atppc);
525 1.1 jdolecek
526 1.1 jdolecek /* Determine readIntrThreshold - fill FIFO until serviceIntr is set */
527 1.1 jdolecek for (i = atppc->sc_rthr = atppc->sc_fifo = 0; i < 1024; i++) {
528 1.1 jdolecek atppc_w_fifo(atppc, (char)i);
529 1.1 jdolecek atppc_barrier_w(atppc);
530 1.9 drochner cc = atppc_r_ecr(atppc);
531 1.1 jdolecek atppc_barrier_r(atppc);
532 1.1 jdolecek if ((atppc->sc_rthr == 0) && (cc & ATPPC_SERVICE_INTR)) {
533 1.1 jdolecek /* readThreshold reached */
534 1.1 jdolecek atppc->sc_rthr = i + 1;
535 1.1 jdolecek }
536 1.1 jdolecek if (cc & ATPPC_FIFO_FULL) {
537 1.1 jdolecek atppc->sc_fifo = i + 1;
538 1.1 jdolecek break;
539 1.1 jdolecek }
540 1.1 jdolecek }
541 1.1 jdolecek if (i >= 1024) {
542 1.9 drochner ATPPC_DPRINTF(("%s(%s): cannot fill FIFO.\n", __func__,
543 1.25 cegger device_xname(dev)));
544 1.1 jdolecek goto error;
545 1.1 jdolecek }
546 1.1 jdolecek
547 1.1 jdolecek /* Change direction */
548 1.1 jdolecek atppc_w_ctr(atppc, (ctr_sav & ~IRQENABLE) & ~PCD);
549 1.1 jdolecek atppc_barrier_w(atppc);
550 1.9 drochner
551 1.5 jdolecek /* Clear the serviceIntr bit we've already set in the above loop */
552 1.5 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_TST);
553 1.5 jdolecek atppc_barrier_w(atppc);
554 1.1 jdolecek
555 1.1 jdolecek /* Determine writeIntrThreshold - empty FIFO until serviceIntr is set */
556 1.9 drochner for (atppc->sc_wthr = 0; i > -1; i--) {
557 1.9 drochner cc = atppc_r_fifo(atppc);
558 1.1 jdolecek atppc_barrier_r(atppc);
559 1.9 drochner if (cc != (char)(atppc->sc_fifo - i - 1)) {
560 1.9 drochner ATPPC_DPRINTF(("%s(%s): invalid data in FIFO.\n",
561 1.25 cegger __func__, device_xname(dev)));
562 1.1 jdolecek goto error;
563 1.1 jdolecek }
564 1.15 drochner
565 1.9 drochner cc = atppc_r_ecr(atppc);
566 1.1 jdolecek atppc_barrier_r(atppc);
567 1.9 drochner if ((atppc->sc_wthr == 0) && (cc & ATPPC_SERVICE_INTR)) {
568 1.1 jdolecek /* writeIntrThreshold reached */
569 1.1 jdolecek atppc->sc_wthr = atppc->sc_fifo - i;
570 1.1 jdolecek }
571 1.15 drochner
572 1.1 jdolecek if (i > 0 && (cc & ATPPC_FIFO_EMPTY)) {
573 1.1 jdolecek /* If FIFO empty before the last byte, error */
574 1.1 jdolecek ATPPC_DPRINTF(("%s(%s): data lost in FIFO.\n", __func__,
575 1.25 cegger device_xname(dev)));
576 1.1 jdolecek goto error;
577 1.1 jdolecek }
578 1.1 jdolecek }
579 1.1 jdolecek
580 1.1 jdolecek /* FIFO must be empty after the last byte */
581 1.9 drochner cc = atppc_r_ecr(atppc);
582 1.1 jdolecek atppc_barrier_r(atppc);
583 1.1 jdolecek if (!(cc & ATPPC_FIFO_EMPTY)) {
584 1.9 drochner ATPPC_DPRINTF(("%s(%s): cannot empty the FIFO.\n", __func__,
585 1.25 cegger device_xname(dev)));
586 1.1 jdolecek goto error;
587 1.1 jdolecek }
588 1.1 jdolecek
589 1.1 jdolecek /* Restore original registers */
590 1.1 jdolecek atppc_w_ctr(atppc, ctr_sav);
591 1.1 jdolecek atppc_w_str(atppc, str_sav);
592 1.1 jdolecek atppc_w_ecr(atppc, ecr_sav);
593 1.1 jdolecek atppc_barrier_w(atppc);
594 1.1 jdolecek
595 1.1 jdolecek /* Update capabilities */
596 1.1 jdolecek atppc->sc_has |= ATPPC_HAS_FIFO;
597 1.1 jdolecek
598 1.1 jdolecek return 0;
599 1.1 jdolecek
600 1.1 jdolecek error:
601 1.1 jdolecek /* Restore original registers */
602 1.1 jdolecek atppc_w_ctr(atppc, ctr_sav);
603 1.1 jdolecek atppc_w_str(atppc, str_sav);
604 1.1 jdolecek atppc_w_ecr(atppc, ecr_sav);
605 1.1 jdolecek atppc_barrier_w(atppc);
606 1.1 jdolecek
607 1.1 jdolecek return (EINVAL);
608 1.1 jdolecek }
609 1.1 jdolecek
610 1.1 jdolecek /* Interrupt handler for atppc device: wakes up read/write functions */
611 1.9 drochner int
612 1.9 drochner atppcintr(void *arg)
613 1.1 jdolecek {
614 1.9 drochner struct atppc_softc *atppc = (struct atppc_softc *)arg;
615 1.26 cegger device_t dev = atppc->sc_dev;
616 1.12 jdolecek int claim = 1;
617 1.1 jdolecek enum { NONE, READER, WRITER } wake_up = NONE;
618 1.1 jdolecek
619 1.1 jdolecek /* Record registers' status */
620 1.1 jdolecek atppc->sc_str_intr = atppc_r_str(atppc);
621 1.1 jdolecek atppc->sc_ctr_intr = atppc_r_ctr(atppc);
622 1.1 jdolecek atppc->sc_ecr_intr = atppc_r_ecr(atppc);
623 1.1 jdolecek atppc_barrier_r(atppc);
624 1.1 jdolecek
625 1.9 drochner /* Determine cause of interrupt and wake up top half */
626 1.9 drochner switch (atppc->sc_mode) {
627 1.1 jdolecek case ATPPC_MODE_STD:
628 1.1 jdolecek /* nAck pulsed for 5 usec, too fast to check reliably, assume */
629 1.1 jdolecek atppc->sc_irqstat = ATPPC_IRQ_nACK;
630 1.9 drochner if (atppc->sc_outb)
631 1.1 jdolecek wake_up = WRITER;
632 1.1 jdolecek else
633 1.12 jdolecek claim = 0;
634 1.1 jdolecek break;
635 1.15 drochner
636 1.1 jdolecek case ATPPC_MODE_NIBBLE:
637 1.1 jdolecek case ATPPC_MODE_PS2:
638 1.1 jdolecek /* nAck is set low by device and then high on ack */
639 1.9 drochner if (!(atppc->sc_str_intr & nACK)) {
640 1.12 jdolecek claim = 0;
641 1.1 jdolecek break;
642 1.1 jdolecek }
643 1.1 jdolecek atppc->sc_irqstat = ATPPC_IRQ_nACK;
644 1.9 drochner if (atppc->sc_inb)
645 1.1 jdolecek wake_up = READER;
646 1.1 jdolecek break;
647 1.1 jdolecek
648 1.1 jdolecek case ATPPC_MODE_ECP:
649 1.1 jdolecek case ATPPC_MODE_FAST:
650 1.1 jdolecek /* Confirm interrupt cause: these are not pulsed as in nAck. */
651 1.9 drochner if (atppc->sc_ecr_intr & ATPPC_SERVICE_INTR) {
652 1.9 drochner if (atppc->sc_ecr_intr & ATPPC_ENABLE_DMA)
653 1.1 jdolecek atppc->sc_irqstat |= ATPPC_IRQ_DMA;
654 1.9 drochner else
655 1.9 drochner atppc->sc_irqstat |= ATPPC_IRQ_FIFO;
656 1.15 drochner
657 1.1 jdolecek /* Decide where top half will be waiting */
658 1.9 drochner if (atppc->sc_mode & ATPPC_MODE_ECP) {
659 1.9 drochner if (atppc->sc_ctr_intr & PCD) {
660 1.9 drochner if (atppc->sc_inb)
661 1.1 jdolecek wake_up = READER;
662 1.1 jdolecek else
663 1.12 jdolecek claim = 0;
664 1.9 drochner } else {
665 1.9 drochner if (atppc->sc_outb)
666 1.1 jdolecek wake_up = WRITER;
667 1.1 jdolecek else
668 1.12 jdolecek claim = 0;
669 1.1 jdolecek }
670 1.9 drochner } else {
671 1.9 drochner if (atppc->sc_outb)
672 1.1 jdolecek wake_up = WRITER;
673 1.1 jdolecek else
674 1.12 jdolecek claim = 0;
675 1.1 jdolecek }
676 1.1 jdolecek }
677 1.14 wiz /* Determine if nFault has occurred */
678 1.9 drochner if ((atppc->sc_mode & ATPPC_MODE_ECP) &&
679 1.9 drochner (atppc->sc_ecr_intr & ATPPC_nFAULT_INTR) &&
680 1.1 jdolecek !(atppc->sc_str_intr & nFAULT)) {
681 1.1 jdolecek
682 1.1 jdolecek /* Device is requesting the channel */
683 1.1 jdolecek atppc->sc_irqstat |= ATPPC_IRQ_nFAULT;
684 1.12 jdolecek claim = 1;
685 1.1 jdolecek }
686 1.1 jdolecek break;
687 1.1 jdolecek
688 1.1 jdolecek case ATPPC_MODE_EPP:
689 1.1 jdolecek /* nAck pulsed for 5 usec, too fast to check reliably */
690 1.1 jdolecek atppc->sc_irqstat = ATPPC_IRQ_nACK;
691 1.9 drochner if (atppc->sc_inb)
692 1.1 jdolecek wake_up = WRITER;
693 1.9 drochner else if (atppc->sc_outb)
694 1.1 jdolecek wake_up = READER;
695 1.9 drochner else
696 1.12 jdolecek claim = 0;
697 1.1 jdolecek break;
698 1.1 jdolecek
699 1.1 jdolecek default:
700 1.25 cegger panic("%s: chipset is in invalid mode.", device_xname(dev));
701 1.1 jdolecek }
702 1.1 jdolecek
703 1.12 jdolecek if (claim) {
704 1.12 jdolecek switch (wake_up) {
705 1.12 jdolecek case NONE:
706 1.12 jdolecek break;
707 1.1 jdolecek
708 1.12 jdolecek case READER:
709 1.12 jdolecek wakeup(atppc->sc_inb);
710 1.12 jdolecek break;
711 1.1 jdolecek
712 1.12 jdolecek case WRITER:
713 1.12 jdolecek wakeup(atppc->sc_outb);
714 1.12 jdolecek break;
715 1.12 jdolecek }
716 1.12 jdolecek }
717 1.1 jdolecek
718 1.1 jdolecek /* Call all of the installed handlers */
719 1.12 jdolecek if (claim) {
720 1.1 jdolecek struct atppc_handler_node * callback;
721 1.9 drochner SLIST_FOREACH(callback, &(atppc->sc_handler_listhead),
722 1.1 jdolecek entries) {
723 1.1 jdolecek (*callback->func)(callback->arg);
724 1.1 jdolecek }
725 1.1 jdolecek }
726 1.12 jdolecek
727 1.12 jdolecek return claim;
728 1.1 jdolecek }
729 1.1 jdolecek
730 1.1 jdolecek
731 1.1 jdolecek /* Functions which support ppbus interface */
732 1.1 jdolecek
733 1.1 jdolecek
734 1.1 jdolecek /* Check EPP mode timeout */
735 1.1 jdolecek static int
736 1.26 cegger atppc_check_epp_timeout(device_t dev)
737 1.1 jdolecek {
738 1.26 cegger struct atppc_softc *atppc = device_private(dev);
739 1.1 jdolecek int s;
740 1.1 jdolecek int error;
741 1.1 jdolecek
742 1.1 jdolecek s = splatppc();
743 1.1 jdolecek ATPPC_LOCK(atppc);
744 1.1 jdolecek
745 1.1 jdolecek atppc_reset_epp_timeout(dev);
746 1.1 jdolecek error = !(atppc_r_str(atppc) & TIMEOUT);
747 1.1 jdolecek atppc_barrier_r(atppc);
748 1.1 jdolecek
749 1.1 jdolecek ATPPC_UNLOCK(atppc);
750 1.1 jdolecek splx(s);
751 1.1 jdolecek
752 1.1 jdolecek return (error);
753 1.1 jdolecek }
754 1.1 jdolecek
755 1.1 jdolecek /*
756 1.1 jdolecek * EPP timeout, according to the PC87332 manual
757 1.1 jdolecek * Semantics of clearing EPP timeout bit.
758 1.1 jdolecek * PC87332 - reading SPP_STR does it...
759 1.1 jdolecek * SMC - write 1 to EPP timeout bit XXX
760 1.1 jdolecek * Others - (?) write 0 to EPP timeout bit
761 1.1 jdolecek */
762 1.1 jdolecek static void
763 1.26 cegger atppc_reset_epp_timeout(device_t dev)
764 1.1 jdolecek {
765 1.26 cegger struct atppc_softc *atppc = device_private(dev);
766 1.1 jdolecek register unsigned char r;
767 1.1 jdolecek
768 1.1 jdolecek r = atppc_r_str(atppc);
769 1.1 jdolecek atppc_barrier_r(atppc);
770 1.1 jdolecek atppc_w_str(atppc, r | 0x1);
771 1.1 jdolecek atppc_barrier_w(atppc);
772 1.1 jdolecek atppc_w_str(atppc, r & 0xfe);
773 1.1 jdolecek atppc_barrier_w(atppc);
774 1.1 jdolecek
775 1.1 jdolecek return;
776 1.1 jdolecek }
777 1.1 jdolecek
778 1.1 jdolecek
779 1.1 jdolecek /* Read from atppc device: returns 0 on success. */
780 1.1 jdolecek static int
781 1.26 cegger atppc_read(device_t dev, char *buf, int len, int ioflag,
782 1.9 drochner size_t *cnt)
783 1.1 jdolecek {
784 1.26 cegger struct atppc_softc *atppc = device_private(dev);
785 1.1 jdolecek int error = 0;
786 1.1 jdolecek int s;
787 1.1 jdolecek
788 1.1 jdolecek s = splatppc();
789 1.1 jdolecek ATPPC_LOCK(atppc);
790 1.1 jdolecek
791 1.1 jdolecek *cnt = 0;
792 1.1 jdolecek
793 1.1 jdolecek /* Initialize buffer */
794 1.1 jdolecek atppc->sc_inb = atppc->sc_inbstart = buf;
795 1.1 jdolecek atppc->sc_inb_nbytes = len;
796 1.1 jdolecek
797 1.1 jdolecek /* Initialize device input error state for new operation */
798 1.1 jdolecek atppc->sc_inerr = 0;
799 1.1 jdolecek
800 1.1 jdolecek /* Call appropriate function to read bytes */
801 1.1 jdolecek switch(atppc->sc_mode) {
802 1.1 jdolecek case ATPPC_MODE_STD:
803 1.1 jdolecek case ATPPC_MODE_FAST:
804 1.1 jdolecek error = ENODEV;
805 1.1 jdolecek break;
806 1.15 drochner
807 1.1 jdolecek case ATPPC_MODE_NIBBLE:
808 1.1 jdolecek atppc_nibble_read(atppc);
809 1.1 jdolecek break;
810 1.1 jdolecek
811 1.1 jdolecek case ATPPC_MODE_PS2:
812 1.1 jdolecek atppc_byte_read(atppc);
813 1.1 jdolecek break;
814 1.1 jdolecek
815 1.1 jdolecek case ATPPC_MODE_ECP:
816 1.1 jdolecek atppc_ecp_read(atppc);
817 1.1 jdolecek break;
818 1.1 jdolecek
819 1.1 jdolecek case ATPPC_MODE_EPP:
820 1.1 jdolecek atppc_epp_read(atppc);
821 1.1 jdolecek break;
822 1.1 jdolecek
823 1.1 jdolecek default:
824 1.9 drochner panic("%s(%s): chipset in invalid mode.\n", __func__,
825 1.25 cegger device_xname(dev));
826 1.1 jdolecek }
827 1.1 jdolecek
828 1.1 jdolecek /* Update counter*/
829 1.1 jdolecek *cnt = (atppc->sc_inbstart - atppc->sc_inb);
830 1.1 jdolecek
831 1.1 jdolecek /* Reset buffer */
832 1.1 jdolecek atppc->sc_inb = atppc->sc_inbstart = NULL;
833 1.1 jdolecek atppc->sc_inb_nbytes = 0;
834 1.1 jdolecek
835 1.9 drochner if (!(error))
836 1.1 jdolecek error = atppc->sc_inerr;
837 1.1 jdolecek
838 1.1 jdolecek ATPPC_UNLOCK(atppc);
839 1.1 jdolecek splx(s);
840 1.1 jdolecek
841 1.1 jdolecek return (error);
842 1.1 jdolecek }
843 1.1 jdolecek
844 1.1 jdolecek /* Write to atppc device: returns 0 on success. */
845 1.1 jdolecek static int
846 1.26 cegger atppc_write(device_t dev, char *buf, int len, int ioflag, size_t *cnt)
847 1.1 jdolecek {
848 1.26 cegger struct atppc_softc * const atppc = device_private(dev);
849 1.1 jdolecek int error = 0;
850 1.1 jdolecek int s;
851 1.1 jdolecek
852 1.1 jdolecek *cnt = 0;
853 1.15 drochner
854 1.1 jdolecek s = splatppc();
855 1.1 jdolecek ATPPC_LOCK(atppc);
856 1.1 jdolecek
857 1.1 jdolecek /* Set up line buffer */
858 1.1 jdolecek atppc->sc_outb = atppc->sc_outbstart = buf;
859 1.1 jdolecek atppc->sc_outb_nbytes = len;
860 1.1 jdolecek
861 1.1 jdolecek /* Initialize device output error state for new operation */
862 1.1 jdolecek atppc->sc_outerr = 0;
863 1.1 jdolecek
864 1.1 jdolecek /* Call appropriate function to write bytes */
865 1.9 drochner switch (atppc->sc_mode) {
866 1.1 jdolecek case ATPPC_MODE_STD:
867 1.1 jdolecek atppc_std_write(atppc);
868 1.1 jdolecek break;
869 1.1 jdolecek
870 1.1 jdolecek case ATPPC_MODE_NIBBLE:
871 1.1 jdolecek case ATPPC_MODE_PS2:
872 1.1 jdolecek error = ENODEV;
873 1.1 jdolecek break;
874 1.1 jdolecek
875 1.1 jdolecek case ATPPC_MODE_FAST:
876 1.1 jdolecek case ATPPC_MODE_ECP:
877 1.1 jdolecek atppc_fifo_write(atppc);
878 1.1 jdolecek break;
879 1.1 jdolecek
880 1.1 jdolecek case ATPPC_MODE_EPP:
881 1.1 jdolecek atppc_epp_write(atppc);
882 1.1 jdolecek break;
883 1.1 jdolecek
884 1.1 jdolecek default:
885 1.9 drochner panic("%s(%s): chipset in invalid mode.\n", __func__,
886 1.25 cegger device_xname(dev));
887 1.1 jdolecek }
888 1.1 jdolecek
889 1.1 jdolecek /* Update counter*/
890 1.1 jdolecek *cnt = (atppc->sc_outbstart - atppc->sc_outb);
891 1.1 jdolecek
892 1.1 jdolecek /* Reset output buffer */
893 1.1 jdolecek atppc->sc_outb = atppc->sc_outbstart = NULL;
894 1.1 jdolecek atppc->sc_outb_nbytes = 0;
895 1.1 jdolecek
896 1.9 drochner if (!(error))
897 1.1 jdolecek error = atppc->sc_outerr;
898 1.1 jdolecek
899 1.1 jdolecek ATPPC_UNLOCK(atppc);
900 1.1 jdolecek splx(s);
901 1.1 jdolecek
902 1.1 jdolecek return (error);
903 1.1 jdolecek }
904 1.1 jdolecek
905 1.9 drochner /*
906 1.9 drochner * Set mode of chipset to mode argument. Modes not supported are ignored. If
907 1.9 drochner * multiple modes are flagged, the mode is not changed. Mode's are those
908 1.9 drochner * defined for ppbus_softc.sc_mode in ppbus_conf.h. Only ECP-capable chipsets
909 1.9 drochner * can change their mode of operation. However, ALL operation modes support
910 1.9 drochner * centronics mode and nibble mode. Modes determine both hardware AND software
911 1.1 jdolecek * behaviour.
912 1.9 drochner * NOTE: the mode for ECP should only be changed when the channel is in
913 1.9 drochner * forward idle mode. This function does not make sure FIFO's have flushed or
914 1.1 jdolecek * any consistency checks.
915 1.1 jdolecek */
916 1.9 drochner static int
917 1.26 cegger atppc_setmode(device_t dev, int mode)
918 1.1 jdolecek {
919 1.26 cegger struct atppc_softc *atppc = device_private(dev);
920 1.9 drochner u_int8_t ecr;
921 1.1 jdolecek u_int8_t chipset_mode;
922 1.1 jdolecek int s;
923 1.1 jdolecek int rval = 0;
924 1.1 jdolecek
925 1.1 jdolecek s = splatppc();
926 1.1 jdolecek ATPPC_LOCK(atppc);
927 1.1 jdolecek
928 1.1 jdolecek /* If ECP capable, configure ecr register */
929 1.1 jdolecek if (atppc->sc_has & ATPPC_HAS_ECP) {
930 1.1 jdolecek /* Read ECR with mode masked out */
931 1.11 jdolecek ecr = (atppc_r_ecr(atppc) & 0x1f);
932 1.1 jdolecek atppc_barrier_r(atppc);
933 1.1 jdolecek
934 1.9 drochner switch (mode) {
935 1.1 jdolecek case PPBUS_ECP:
936 1.1 jdolecek /* Set ECP mode */
937 1.1 jdolecek ecr |= ATPPC_ECR_ECP;
938 1.1 jdolecek chipset_mode = ATPPC_MODE_ECP;
939 1.1 jdolecek break;
940 1.1 jdolecek
941 1.1 jdolecek case PPBUS_EPP:
942 1.1 jdolecek /* Set EPP mode */
943 1.9 drochner if (atppc->sc_has & ATPPC_HAS_EPP) {
944 1.1 jdolecek ecr |= ATPPC_ECR_EPP;
945 1.1 jdolecek chipset_mode = ATPPC_MODE_EPP;
946 1.9 drochner } else {
947 1.1 jdolecek rval = ENODEV;
948 1.1 jdolecek goto end;
949 1.1 jdolecek }
950 1.1 jdolecek break;
951 1.1 jdolecek
952 1.1 jdolecek case PPBUS_FAST:
953 1.1 jdolecek /* Set fast centronics mode */
954 1.1 jdolecek ecr |= ATPPC_ECR_FIFO;
955 1.1 jdolecek chipset_mode = ATPPC_MODE_FAST;
956 1.1 jdolecek break;
957 1.1 jdolecek
958 1.1 jdolecek case PPBUS_PS2:
959 1.1 jdolecek /* Set PS2 mode */
960 1.1 jdolecek ecr |= ATPPC_ECR_PS2;
961 1.1 jdolecek chipset_mode = ATPPC_MODE_PS2;
962 1.1 jdolecek break;
963 1.1 jdolecek
964 1.1 jdolecek case PPBUS_COMPATIBLE:
965 1.1 jdolecek /* Set standard mode */
966 1.1 jdolecek ecr |= ATPPC_ECR_STD;
967 1.15 drochner chipset_mode = ATPPC_MODE_STD;
968 1.1 jdolecek break;
969 1.1 jdolecek
970 1.1 jdolecek case PPBUS_NIBBLE:
971 1.1 jdolecek /* Set nibble mode: uses chipset standard mode */
972 1.1 jdolecek ecr |= ATPPC_ECR_STD;
973 1.1 jdolecek chipset_mode = ATPPC_MODE_NIBBLE;
974 1.1 jdolecek break;
975 1.1 jdolecek
976 1.1 jdolecek default:
977 1.1 jdolecek /* Invalid mode specified for ECP chip */
978 1.1 jdolecek ATPPC_DPRINTF(("%s(%s): invalid mode passed as "
979 1.25 cegger "argument.\n", __func__, device_xname(dev)));
980 1.1 jdolecek rval = ENODEV;
981 1.1 jdolecek goto end;
982 1.1 jdolecek }
983 1.1 jdolecek
984 1.1 jdolecek /* Switch to byte mode to be able to change modes. */
985 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
986 1.1 jdolecek atppc_barrier_w(atppc);
987 1.1 jdolecek
988 1.1 jdolecek /* Update mode */
989 1.1 jdolecek atppc_w_ecr(atppc, ecr);
990 1.1 jdolecek atppc_barrier_w(atppc);
991 1.9 drochner } else {
992 1.9 drochner switch (mode) {
993 1.1 jdolecek case PPBUS_EPP:
994 1.9 drochner if (atppc->sc_has & ATPPC_HAS_EPP) {
995 1.1 jdolecek chipset_mode = ATPPC_MODE_EPP;
996 1.9 drochner } else {
997 1.1 jdolecek rval = ENODEV;
998 1.1 jdolecek goto end;
999 1.1 jdolecek }
1000 1.1 jdolecek break;
1001 1.1 jdolecek
1002 1.1 jdolecek case PPBUS_PS2:
1003 1.9 drochner if (atppc->sc_has & ATPPC_HAS_PS2) {
1004 1.1 jdolecek chipset_mode = ATPPC_MODE_PS2;
1005 1.9 drochner } else {
1006 1.1 jdolecek rval = ENODEV;
1007 1.1 jdolecek goto end;
1008 1.1 jdolecek }
1009 1.1 jdolecek break;
1010 1.1 jdolecek
1011 1.1 jdolecek case PPBUS_NIBBLE:
1012 1.1 jdolecek /* Set nibble mode (virtual) */
1013 1.1 jdolecek chipset_mode = ATPPC_MODE_NIBBLE;
1014 1.1 jdolecek break;
1015 1.1 jdolecek
1016 1.1 jdolecek case PPBUS_COMPATIBLE:
1017 1.1 jdolecek chipset_mode = ATPPC_MODE_STD;
1018 1.1 jdolecek break;
1019 1.1 jdolecek
1020 1.1 jdolecek case PPBUS_ECP:
1021 1.1 jdolecek rval = ENODEV;
1022 1.1 jdolecek goto end;
1023 1.1 jdolecek
1024 1.1 jdolecek default:
1025 1.1 jdolecek ATPPC_DPRINTF(("%s(%s): invalid mode passed as "
1026 1.25 cegger "argument.\n", __func__, device_xname(dev)));
1027 1.1 jdolecek rval = ENODEV;
1028 1.1 jdolecek goto end;
1029 1.1 jdolecek }
1030 1.1 jdolecek }
1031 1.1 jdolecek
1032 1.1 jdolecek atppc->sc_mode = chipset_mode;
1033 1.9 drochner if (chipset_mode == ATPPC_MODE_PS2) {
1034 1.1 jdolecek /* Set direction bit to reverse */
1035 1.1 jdolecek ecr = atppc_r_ctr(atppc);
1036 1.1 jdolecek atppc_barrier_r(atppc);
1037 1.1 jdolecek ecr |= PCD;
1038 1.1 jdolecek atppc_w_ctr(atppc, ecr);
1039 1.1 jdolecek atppc_barrier_w(atppc);
1040 1.1 jdolecek }
1041 1.1 jdolecek
1042 1.1 jdolecek end:
1043 1.1 jdolecek ATPPC_UNLOCK(atppc);
1044 1.1 jdolecek splx(s);
1045 1.1 jdolecek
1046 1.1 jdolecek return rval;
1047 1.1 jdolecek }
1048 1.1 jdolecek
1049 1.1 jdolecek /* Get the current mode of chipset */
1050 1.1 jdolecek static int
1051 1.26 cegger atppc_getmode(device_t dev)
1052 1.1 jdolecek {
1053 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1054 1.1 jdolecek int mode;
1055 1.1 jdolecek int s;
1056 1.1 jdolecek
1057 1.1 jdolecek s = splatppc();
1058 1.1 jdolecek ATPPC_LOCK(atppc);
1059 1.1 jdolecek
1060 1.1 jdolecek /* The chipset can only be in one mode at a time logically */
1061 1.9 drochner switch (atppc->sc_mode) {
1062 1.1 jdolecek case ATPPC_MODE_ECP:
1063 1.1 jdolecek mode = PPBUS_ECP;
1064 1.1 jdolecek break;
1065 1.1 jdolecek
1066 1.1 jdolecek case ATPPC_MODE_EPP:
1067 1.1 jdolecek mode = PPBUS_EPP;
1068 1.1 jdolecek break;
1069 1.1 jdolecek
1070 1.1 jdolecek case ATPPC_MODE_PS2:
1071 1.1 jdolecek mode = PPBUS_PS2;
1072 1.1 jdolecek break;
1073 1.1 jdolecek
1074 1.1 jdolecek case ATPPC_MODE_STD:
1075 1.1 jdolecek mode = PPBUS_COMPATIBLE;
1076 1.1 jdolecek break;
1077 1.1 jdolecek
1078 1.1 jdolecek case ATPPC_MODE_NIBBLE:
1079 1.1 jdolecek mode = PPBUS_NIBBLE;
1080 1.1 jdolecek break;
1081 1.1 jdolecek
1082 1.1 jdolecek case ATPPC_MODE_FAST:
1083 1.1 jdolecek mode = PPBUS_FAST;
1084 1.1 jdolecek break;
1085 1.1 jdolecek
1086 1.1 jdolecek default:
1087 1.9 drochner panic("%s(%s): device is in invalid mode!", __func__,
1088 1.25 cegger device_xname(dev));
1089 1.1 jdolecek break;
1090 1.1 jdolecek }
1091 1.1 jdolecek
1092 1.1 jdolecek ATPPC_UNLOCK(atppc);
1093 1.1 jdolecek splx(s);
1094 1.1 jdolecek
1095 1.1 jdolecek return mode;
1096 1.1 jdolecek }
1097 1.1 jdolecek
1098 1.1 jdolecek
1099 1.9 drochner /* Wait for FIFO buffer to empty for ECP-capable chipset */
1100 1.1 jdolecek static void
1101 1.26 cegger atppc_ecp_sync(device_t dev)
1102 1.1 jdolecek {
1103 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1104 1.1 jdolecek int i;
1105 1.1 jdolecek int s;
1106 1.1 jdolecek u_int8_t r;
1107 1.1 jdolecek
1108 1.1 jdolecek s = splatppc();
1109 1.1 jdolecek ATPPC_LOCK(atppc);
1110 1.1 jdolecek
1111 1.9 drochner /*
1112 1.9 drochner * Only wait for FIFO to empty if mode is chipset is ECP-capable AND
1113 1.1 jdolecek * the mode is either ECP or Fast Centronics.
1114 1.1 jdolecek */
1115 1.1 jdolecek r = atppc_r_ecr(atppc);
1116 1.1 jdolecek atppc_barrier_r(atppc);
1117 1.1 jdolecek r &= 0xe0;
1118 1.9 drochner if (!(atppc->sc_has & ATPPC_HAS_ECP) || ((r != ATPPC_ECR_ECP)
1119 1.1 jdolecek && (r != ATPPC_ECR_FIFO))) {
1120 1.1 jdolecek goto end;
1121 1.1 jdolecek }
1122 1.1 jdolecek
1123 1.1 jdolecek /* Wait for FIFO to empty */
1124 1.1 jdolecek for (i = 0; i < ((MAXBUSYWAIT/hz) * 1000000); i += 100) {
1125 1.1 jdolecek r = atppc_r_ecr(atppc);
1126 1.1 jdolecek atppc_barrier_r(atppc);
1127 1.1 jdolecek if (r & ATPPC_FIFO_EMPTY) {
1128 1.1 jdolecek goto end;
1129 1.1 jdolecek }
1130 1.1 jdolecek delay(100); /* Supposed to be a 100 usec delay */
1131 1.1 jdolecek }
1132 1.1 jdolecek
1133 1.9 drochner ATPPC_DPRINTF(("%s: ECP sync failed, data still in FIFO.\n",
1134 1.25 cegger device_xname(dev)));
1135 1.1 jdolecek
1136 1.1 jdolecek end:
1137 1.1 jdolecek ATPPC_UNLOCK(atppc);
1138 1.1 jdolecek splx(s);
1139 1.15 drochner
1140 1.1 jdolecek return;
1141 1.1 jdolecek }
1142 1.1 jdolecek
1143 1.1 jdolecek /* Execute a microsequence to handle fast I/O operations. */
1144 1.1 jdolecek static int
1145 1.26 cegger atppc_exec_microseq(device_t dev, struct ppbus_microseq **p_msq)
1146 1.1 jdolecek {
1147 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1148 1.9 drochner struct ppbus_microseq *mi = *p_msq;
1149 1.9 drochner char cc, *p;
1150 1.1 jdolecek int i, iter, len;
1151 1.1 jdolecek int error;
1152 1.1 jdolecek int s;
1153 1.1 jdolecek register int reg;
1154 1.1 jdolecek register unsigned char mask;
1155 1.1 jdolecek register int accum = 0;
1156 1.9 drochner register char *ptr = NULL;
1157 1.9 drochner struct ppbus_microseq *stack = NULL;
1158 1.1 jdolecek
1159 1.1 jdolecek s = splatppc();
1160 1.1 jdolecek ATPPC_LOCK(atppc);
1161 1.1 jdolecek
1162 1.1 jdolecek /* microsequence registers are equivalent to PC-like port registers */
1163 1.1 jdolecek
1164 1.1 jdolecek #define r_reg(register,atppc) bus_space_read_1((atppc)->sc_iot, \
1165 1.1 jdolecek (atppc)->sc_ioh, (register))
1166 1.1 jdolecek #define w_reg(register, atppc, byte) bus_space_write_1((atppc)->sc_iot, \
1167 1.1 jdolecek (atppc)->sc_ioh, (register), (byte))
1168 1.1 jdolecek
1169 1.1 jdolecek /* Loop until microsequence execution finishes (ending op code) */
1170 1.1 jdolecek for (;;) {
1171 1.9 drochner switch (mi->opcode) {
1172 1.1 jdolecek case MS_OP_RSET:
1173 1.1 jdolecek cc = r_reg(mi->arg[0].i, atppc);
1174 1.1 jdolecek atppc_barrier_r(atppc);
1175 1.1 jdolecek cc &= (char)mi->arg[2].i; /* clear mask */
1176 1.1 jdolecek cc |= (char)mi->arg[1].i; /* assert mask */
1177 1.1 jdolecek w_reg(mi->arg[0].i, atppc, cc);
1178 1.1 jdolecek atppc_barrier_w(atppc);
1179 1.1 jdolecek mi++;
1180 1.1 jdolecek break;
1181 1.1 jdolecek
1182 1.1 jdolecek case MS_OP_RASSERT_P:
1183 1.1 jdolecek reg = mi->arg[1].i;
1184 1.1 jdolecek ptr = atppc->sc_ptr;
1185 1.1 jdolecek
1186 1.9 drochner if ((len = mi->arg[0].i) == MS_ACCUM) {
1187 1.1 jdolecek accum = atppc->sc_accum;
1188 1.1 jdolecek for (; accum; accum--) {
1189 1.1 jdolecek w_reg(reg, atppc, *ptr++);
1190 1.1 jdolecek atppc_barrier_w(atppc);
1191 1.1 jdolecek }
1192 1.1 jdolecek atppc->sc_accum = accum;
1193 1.9 drochner } else {
1194 1.9 drochner for (i = 0; i < len; i++) {
1195 1.1 jdolecek w_reg(reg, atppc, *ptr++);
1196 1.1 jdolecek atppc_barrier_w(atppc);
1197 1.1 jdolecek }
1198 1.1 jdolecek }
1199 1.1 jdolecek
1200 1.1 jdolecek atppc->sc_ptr = ptr;
1201 1.1 jdolecek mi++;
1202 1.1 jdolecek break;
1203 1.1 jdolecek
1204 1.1 jdolecek case MS_OP_RFETCH_P:
1205 1.1 jdolecek reg = mi->arg[1].i;
1206 1.1 jdolecek mask = (char)mi->arg[2].i;
1207 1.1 jdolecek ptr = atppc->sc_ptr;
1208 1.1 jdolecek
1209 1.9 drochner if ((len = mi->arg[0].i) == MS_ACCUM) {
1210 1.1 jdolecek accum = atppc->sc_accum;
1211 1.1 jdolecek for (; accum; accum--) {
1212 1.1 jdolecek *ptr++ = r_reg(reg, atppc) & mask;
1213 1.1 jdolecek atppc_barrier_r(atppc);
1214 1.1 jdolecek }
1215 1.1 jdolecek atppc->sc_accum = accum;
1216 1.9 drochner } else {
1217 1.9 drochner for (i = 0; i < len; i++) {
1218 1.1 jdolecek *ptr++ = r_reg(reg, atppc) & mask;
1219 1.1 jdolecek atppc_barrier_r(atppc);
1220 1.1 jdolecek }
1221 1.1 jdolecek }
1222 1.1 jdolecek
1223 1.1 jdolecek atppc->sc_ptr = ptr;
1224 1.1 jdolecek mi++;
1225 1.9 drochner break;
1226 1.1 jdolecek
1227 1.1 jdolecek case MS_OP_RFETCH:
1228 1.9 drochner *((char *)mi->arg[2].p) = r_reg(mi->arg[0].i, atppc) &
1229 1.1 jdolecek (char)mi->arg[1].i;
1230 1.1 jdolecek atppc_barrier_r(atppc);
1231 1.1 jdolecek mi++;
1232 1.9 drochner break;
1233 1.1 jdolecek
1234 1.1 jdolecek case MS_OP_RASSERT:
1235 1.1 jdolecek case MS_OP_DELAY:
1236 1.1 jdolecek /* let's suppose the next instr. is the same */
1237 1.1 jdolecek do {
1238 1.9 drochner for (;mi->opcode == MS_OP_RASSERT; mi++) {
1239 1.9 drochner w_reg(mi->arg[0].i, atppc,
1240 1.1 jdolecek (char)mi->arg[1].i);
1241 1.1 jdolecek atppc_barrier_w(atppc);
1242 1.1 jdolecek }
1243 1.1 jdolecek
1244 1.9 drochner for (;mi->opcode == MS_OP_DELAY; mi++) {
1245 1.1 jdolecek delay(mi->arg[0].i);
1246 1.1 jdolecek }
1247 1.9 drochner } while (mi->opcode == MS_OP_RASSERT);
1248 1.1 jdolecek break;
1249 1.1 jdolecek
1250 1.1 jdolecek case MS_OP_ADELAY:
1251 1.9 drochner if (mi->arg[0].i) {
1252 1.1 jdolecek tsleep(atppc, PPBUSPRI, "atppcdelay",
1253 1.1 jdolecek mi->arg[0].i * (hz/1000));
1254 1.1 jdolecek }
1255 1.1 jdolecek mi++;
1256 1.1 jdolecek break;
1257 1.1 jdolecek
1258 1.1 jdolecek case MS_OP_TRIG:
1259 1.1 jdolecek reg = mi->arg[0].i;
1260 1.1 jdolecek iter = mi->arg[1].i;
1261 1.1 jdolecek p = (char *)mi->arg[2].p;
1262 1.1 jdolecek
1263 1.1 jdolecek /* XXX delay limited to 255 us */
1264 1.9 drochner for (i = 0; i < iter; i++) {
1265 1.1 jdolecek w_reg(reg, atppc, *p++);
1266 1.1 jdolecek atppc_barrier_w(atppc);
1267 1.1 jdolecek delay((unsigned char)*p++);
1268 1.1 jdolecek }
1269 1.1 jdolecek
1270 1.1 jdolecek mi++;
1271 1.1 jdolecek break;
1272 1.1 jdolecek
1273 1.1 jdolecek case MS_OP_SET:
1274 1.1 jdolecek atppc->sc_accum = mi->arg[0].i;
1275 1.1 jdolecek mi++;
1276 1.9 drochner break;
1277 1.1 jdolecek
1278 1.1 jdolecek case MS_OP_DBRA:
1279 1.9 drochner if (--atppc->sc_accum > 0) {
1280 1.1 jdolecek mi += mi->arg[0].i;
1281 1.1 jdolecek }
1282 1.15 drochner
1283 1.1 jdolecek mi++;
1284 1.9 drochner break;
1285 1.1 jdolecek
1286 1.1 jdolecek case MS_OP_BRSET:
1287 1.1 jdolecek cc = atppc_r_str(atppc);
1288 1.1 jdolecek atppc_barrier_r(atppc);
1289 1.9 drochner if ((cc & (char)mi->arg[0].i) == (char)mi->arg[0].i) {
1290 1.1 jdolecek mi += mi->arg[1].i;
1291 1.1 jdolecek }
1292 1.1 jdolecek mi++;
1293 1.1 jdolecek break;
1294 1.1 jdolecek
1295 1.1 jdolecek case MS_OP_BRCLEAR:
1296 1.1 jdolecek cc = atppc_r_str(atppc);
1297 1.1 jdolecek atppc_barrier_r(atppc);
1298 1.9 drochner if ((cc & (char)mi->arg[0].i) == 0) {
1299 1.9 drochner mi += mi->arg[1].i;
1300 1.1 jdolecek }
1301 1.1 jdolecek mi++;
1302 1.9 drochner break;
1303 1.1 jdolecek
1304 1.1 jdolecek case MS_OP_BRSTAT:
1305 1.1 jdolecek cc = atppc_r_str(atppc);
1306 1.1 jdolecek atppc_barrier_r(atppc);
1307 1.9 drochner if ((cc & ((char)mi->arg[0].i | (char)mi->arg[1].i)) ==
1308 1.1 jdolecek (char)mi->arg[0].i) {
1309 1.1 jdolecek mi += mi->arg[2].i;
1310 1.1 jdolecek }
1311 1.1 jdolecek mi++;
1312 1.1 jdolecek break;
1313 1.1 jdolecek
1314 1.1 jdolecek case MS_OP_C_CALL:
1315 1.1 jdolecek /*
1316 1.1 jdolecek * If the C call returns !0 then end the microseq.
1317 1.1 jdolecek * The current state of ptr is passed to the C function
1318 1.1 jdolecek */
1319 1.9 drochner if ((error = mi->arg[0].f(mi->arg[1].p,
1320 1.1 jdolecek atppc->sc_ptr))) {
1321 1.1 jdolecek ATPPC_UNLOCK(atppc);
1322 1.1 jdolecek splx(s);
1323 1.1 jdolecek return (error);
1324 1.1 jdolecek }
1325 1.1 jdolecek mi++;
1326 1.1 jdolecek break;
1327 1.1 jdolecek
1328 1.1 jdolecek case MS_OP_PTR:
1329 1.1 jdolecek atppc->sc_ptr = (char *)mi->arg[0].p;
1330 1.1 jdolecek mi++;
1331 1.1 jdolecek break;
1332 1.1 jdolecek
1333 1.1 jdolecek case MS_OP_CALL:
1334 1.1 jdolecek if (stack) {
1335 1.25 cegger panic("%s - %s: too much calls", device_xname(dev),
1336 1.1 jdolecek __func__);
1337 1.1 jdolecek }
1338 1.1 jdolecek
1339 1.1 jdolecek if (mi->arg[0].p) {
1340 1.1 jdolecek /* store state of the actual microsequence */
1341 1.1 jdolecek stack = mi;
1342 1.1 jdolecek
1343 1.1 jdolecek /* jump to the new microsequence */
1344 1.1 jdolecek mi = (struct ppbus_microseq *)mi->arg[0].p;
1345 1.9 drochner } else {
1346 1.1 jdolecek mi++;
1347 1.1 jdolecek }
1348 1.1 jdolecek break;
1349 1.1 jdolecek
1350 1.1 jdolecek case MS_OP_SUBRET:
1351 1.1 jdolecek /* retrieve microseq and pc state before the call */
1352 1.1 jdolecek mi = stack;
1353 1.1 jdolecek
1354 1.1 jdolecek /* reset the stack */
1355 1.1 jdolecek stack = 0;
1356 1.1 jdolecek
1357 1.1 jdolecek /* XXX return code */
1358 1.1 jdolecek
1359 1.1 jdolecek mi++;
1360 1.1 jdolecek break;
1361 1.1 jdolecek
1362 1.1 jdolecek case MS_OP_PUT:
1363 1.1 jdolecek case MS_OP_GET:
1364 1.1 jdolecek case MS_OP_RET:
1365 1.9 drochner /*
1366 1.1 jdolecek * Can't return to atppc level during the execution
1367 1.1 jdolecek * of a submicrosequence.
1368 1.1 jdolecek */
1369 1.1 jdolecek if (stack) {
1370 1.9 drochner panic("%s: cannot return to atppc level",
1371 1.1 jdolecek __func__);
1372 1.1 jdolecek }
1373 1.1 jdolecek /* update pc for atppc level of execution */
1374 1.1 jdolecek *p_msq = mi;
1375 1.1 jdolecek
1376 1.1 jdolecek ATPPC_UNLOCK(atppc);
1377 1.1 jdolecek splx(s);
1378 1.1 jdolecek return (0);
1379 1.1 jdolecek break;
1380 1.1 jdolecek
1381 1.9 drochner default:
1382 1.1 jdolecek panic("%s: unknown microsequence "
1383 1.9 drochner "opcode 0x%x", __func__, mi->opcode);
1384 1.1 jdolecek break;
1385 1.1 jdolecek }
1386 1.1 jdolecek }
1387 1.1 jdolecek
1388 1.1 jdolecek /* Should not be reached! */
1389 1.1 jdolecek #ifdef ATPPC_DEBUG
1390 1.1 jdolecek panic("%s: unexpected code reached!\n", __func__);
1391 1.1 jdolecek #endif
1392 1.1 jdolecek }
1393 1.1 jdolecek
1394 1.1 jdolecek /* General I/O routine */
1395 1.1 jdolecek static u_int8_t
1396 1.26 cegger atppc_io(device_t dev, int iop, u_char *addr, int cnt, u_char byte)
1397 1.1 jdolecek {
1398 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1399 1.1 jdolecek u_int8_t val = 0;
1400 1.1 jdolecek int s;
1401 1.1 jdolecek
1402 1.1 jdolecek s = splatppc();
1403 1.1 jdolecek ATPPC_LOCK(atppc);
1404 1.15 drochner
1405 1.1 jdolecek switch (iop) {
1406 1.1 jdolecek case PPBUS_OUTSB_EPP:
1407 1.9 drochner bus_space_write_multi_1(atppc->sc_iot, atppc->sc_ioh,
1408 1.1 jdolecek ATPPC_EPP_DATA, addr, cnt);
1409 1.1 jdolecek break;
1410 1.1 jdolecek case PPBUS_OUTSW_EPP:
1411 1.9 drochner bus_space_write_multi_2(atppc->sc_iot, atppc->sc_ioh,
1412 1.1 jdolecek ATPPC_EPP_DATA, (u_int16_t *)addr, cnt);
1413 1.1 jdolecek break;
1414 1.1 jdolecek case PPBUS_OUTSL_EPP:
1415 1.9 drochner bus_space_write_multi_4(atppc->sc_iot, atppc->sc_ioh,
1416 1.1 jdolecek ATPPC_EPP_DATA, (u_int32_t *)addr, cnt);
1417 1.1 jdolecek break;
1418 1.1 jdolecek case PPBUS_INSB_EPP:
1419 1.9 drochner bus_space_read_multi_1(atppc->sc_iot, atppc->sc_ioh,
1420 1.1 jdolecek ATPPC_EPP_DATA, addr, cnt);
1421 1.1 jdolecek break;
1422 1.1 jdolecek case PPBUS_INSW_EPP:
1423 1.9 drochner bus_space_read_multi_2(atppc->sc_iot, atppc->sc_ioh,
1424 1.1 jdolecek ATPPC_EPP_DATA, (u_int16_t *)addr, cnt);
1425 1.1 jdolecek break;
1426 1.1 jdolecek case PPBUS_INSL_EPP:
1427 1.9 drochner bus_space_read_multi_4(atppc->sc_iot, atppc->sc_ioh,
1428 1.1 jdolecek ATPPC_EPP_DATA, (u_int32_t *)addr, cnt);
1429 1.1 jdolecek break;
1430 1.1 jdolecek case PPBUS_RDTR:
1431 1.1 jdolecek val = (atppc_r_dtr(atppc));
1432 1.1 jdolecek break;
1433 1.1 jdolecek case PPBUS_RSTR:
1434 1.1 jdolecek val = (atppc_r_str(atppc));
1435 1.1 jdolecek break;
1436 1.1 jdolecek case PPBUS_RCTR:
1437 1.1 jdolecek val = (atppc_r_ctr(atppc));
1438 1.1 jdolecek break;
1439 1.1 jdolecek case PPBUS_REPP_A:
1440 1.1 jdolecek val = (atppc_r_eppA(atppc));
1441 1.1 jdolecek break;
1442 1.1 jdolecek case PPBUS_REPP_D:
1443 1.1 jdolecek val = (atppc_r_eppD(atppc));
1444 1.1 jdolecek break;
1445 1.1 jdolecek case PPBUS_RECR:
1446 1.1 jdolecek val = (atppc_r_ecr(atppc));
1447 1.1 jdolecek break;
1448 1.1 jdolecek case PPBUS_RFIFO:
1449 1.1 jdolecek val = (atppc_r_fifo(atppc));
1450 1.1 jdolecek break;
1451 1.1 jdolecek case PPBUS_WDTR:
1452 1.1 jdolecek atppc_w_dtr(atppc, byte);
1453 1.1 jdolecek break;
1454 1.1 jdolecek case PPBUS_WSTR:
1455 1.1 jdolecek atppc_w_str(atppc, byte);
1456 1.1 jdolecek break;
1457 1.1 jdolecek case PPBUS_WCTR:
1458 1.1 jdolecek atppc_w_ctr(atppc, byte);
1459 1.1 jdolecek break;
1460 1.1 jdolecek case PPBUS_WEPP_A:
1461 1.1 jdolecek atppc_w_eppA(atppc, byte);
1462 1.1 jdolecek break;
1463 1.1 jdolecek case PPBUS_WEPP_D:
1464 1.1 jdolecek atppc_w_eppD(atppc, byte);
1465 1.1 jdolecek break;
1466 1.1 jdolecek case PPBUS_WECR:
1467 1.1 jdolecek atppc_w_ecr(atppc, byte);
1468 1.1 jdolecek break;
1469 1.1 jdolecek case PPBUS_WFIFO:
1470 1.1 jdolecek atppc_w_fifo(atppc, byte);
1471 1.1 jdolecek break;
1472 1.1 jdolecek default:
1473 1.25 cegger panic("%s(%s): unknown I/O operation", device_xname(dev),
1474 1.1 jdolecek __func__);
1475 1.1 jdolecek break;
1476 1.1 jdolecek }
1477 1.1 jdolecek
1478 1.1 jdolecek atppc_barrier(atppc);
1479 1.1 jdolecek
1480 1.1 jdolecek ATPPC_UNLOCK(atppc);
1481 1.1 jdolecek splx(s);
1482 1.15 drochner
1483 1.1 jdolecek return val;
1484 1.1 jdolecek }
1485 1.1 jdolecek
1486 1.1 jdolecek /* Read "instance variables" of atppc device */
1487 1.1 jdolecek static int
1488 1.26 cegger atppc_read_ivar(device_t dev, int index, unsigned int *val)
1489 1.1 jdolecek {
1490 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1491 1.1 jdolecek int rval = 0;
1492 1.1 jdolecek int s;
1493 1.1 jdolecek
1494 1.1 jdolecek s = splatppc();
1495 1.1 jdolecek ATPPC_LOCK(atppc);
1496 1.15 drochner
1497 1.1 jdolecek switch(index) {
1498 1.1 jdolecek case PPBUS_IVAR_EPP_PROTO:
1499 1.9 drochner if (atppc->sc_epp == ATPPC_EPP_1_9)
1500 1.1 jdolecek *val = PPBUS_EPP_1_9;
1501 1.9 drochner else if (atppc->sc_epp == ATPPC_EPP_1_7)
1502 1.1 jdolecek *val = PPBUS_EPP_1_7;
1503 1.11 jdolecek /* XXX what if not using EPP ? */
1504 1.1 jdolecek break;
1505 1.1 jdolecek
1506 1.1 jdolecek case PPBUS_IVAR_INTR:
1507 1.11 jdolecek *val = ((atppc->sc_use & ATPPC_USE_INTR) != 0);
1508 1.1 jdolecek break;
1509 1.1 jdolecek
1510 1.1 jdolecek case PPBUS_IVAR_DMA:
1511 1.11 jdolecek *val = ((atppc->sc_use & ATPPC_USE_DMA) != 0);
1512 1.1 jdolecek break;
1513 1.1 jdolecek
1514 1.1 jdolecek default:
1515 1.1 jdolecek rval = ENODEV;
1516 1.1 jdolecek }
1517 1.1 jdolecek
1518 1.1 jdolecek ATPPC_UNLOCK(atppc);
1519 1.1 jdolecek splx(s);
1520 1.15 drochner
1521 1.1 jdolecek return rval;
1522 1.1 jdolecek }
1523 1.1 jdolecek
1524 1.1 jdolecek /* Write "instance varaibles" of atppc device */
1525 1.1 jdolecek static int
1526 1.26 cegger atppc_write_ivar(device_t dev, int index, unsigned int *val)
1527 1.1 jdolecek {
1528 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1529 1.1 jdolecek int rval = 0;
1530 1.1 jdolecek int s;
1531 1.1 jdolecek
1532 1.1 jdolecek s = splatppc();
1533 1.1 jdolecek ATPPC_LOCK(atppc);
1534 1.15 drochner
1535 1.1 jdolecek switch(index) {
1536 1.1 jdolecek case PPBUS_IVAR_EPP_PROTO:
1537 1.9 drochner if (*val == PPBUS_EPP_1_9 || *val == PPBUS_EPP_1_7)
1538 1.1 jdolecek atppc->sc_epp = *val;
1539 1.1 jdolecek else
1540 1.1 jdolecek rval = EINVAL;
1541 1.1 jdolecek break;
1542 1.1 jdolecek
1543 1.1 jdolecek case PPBUS_IVAR_INTR:
1544 1.9 drochner if (*val == 0)
1545 1.1 jdolecek atppc->sc_use &= ~ATPPC_USE_INTR;
1546 1.9 drochner else if (atppc->sc_has & ATPPC_HAS_INTR)
1547 1.1 jdolecek atppc->sc_use |= ATPPC_USE_INTR;
1548 1.1 jdolecek else
1549 1.9 drochner rval = ENODEV;
1550 1.1 jdolecek break;
1551 1.1 jdolecek
1552 1.1 jdolecek case PPBUS_IVAR_DMA:
1553 1.9 drochner if (*val == 0)
1554 1.1 jdolecek atppc->sc_use &= ~ATPPC_USE_DMA;
1555 1.9 drochner else if (atppc->sc_has & ATPPC_HAS_DMA)
1556 1.1 jdolecek atppc->sc_use |= ATPPC_USE_DMA;
1557 1.1 jdolecek else
1558 1.9 drochner rval = ENODEV;
1559 1.1 jdolecek break;
1560 1.1 jdolecek
1561 1.1 jdolecek default:
1562 1.1 jdolecek rval = ENODEV;
1563 1.1 jdolecek }
1564 1.1 jdolecek
1565 1.1 jdolecek ATPPC_UNLOCK(atppc);
1566 1.1 jdolecek splx(s);
1567 1.15 drochner
1568 1.1 jdolecek return rval;
1569 1.1 jdolecek }
1570 1.1 jdolecek
1571 1.1 jdolecek /* Add a handler routine to be called by the interrupt handler */
1572 1.9 drochner static int
1573 1.26 cegger atppc_add_handler(device_t dev, void (*handler)(void *), void *arg)
1574 1.1 jdolecek {
1575 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1576 1.9 drochner struct atppc_handler_node *callback;
1577 1.1 jdolecek int rval = 0;
1578 1.1 jdolecek int s;
1579 1.1 jdolecek
1580 1.1 jdolecek s = splatppc();
1581 1.1 jdolecek ATPPC_LOCK(atppc);
1582 1.1 jdolecek
1583 1.9 drochner if (handler == NULL) {
1584 1.9 drochner ATPPC_DPRINTF(("%s(%s): attempt to register NULL handler.\n",
1585 1.25 cegger __func__, device_xname(dev)));
1586 1.1 jdolecek rval = EINVAL;
1587 1.9 drochner } else {
1588 1.9 drochner callback = malloc(sizeof(struct atppc_handler_node), M_DEVBUF,
1589 1.1 jdolecek M_NOWAIT);
1590 1.9 drochner if (callback) {
1591 1.1 jdolecek callback->func = handler;
1592 1.1 jdolecek callback->arg = arg;
1593 1.9 drochner SLIST_INSERT_HEAD(&(atppc->sc_handler_listhead),
1594 1.1 jdolecek callback, entries);
1595 1.9 drochner } else {
1596 1.1 jdolecek rval = ENOMEM;
1597 1.1 jdolecek }
1598 1.1 jdolecek }
1599 1.1 jdolecek
1600 1.1 jdolecek ATPPC_UNLOCK(atppc);
1601 1.1 jdolecek splx(s);
1602 1.15 drochner
1603 1.1 jdolecek return rval;
1604 1.1 jdolecek }
1605 1.1 jdolecek
1606 1.1 jdolecek /* Remove a handler added by atppc_add_handler() */
1607 1.9 drochner static int
1608 1.26 cegger atppc_remove_handler(device_t dev, void (*handler)(void *))
1609 1.1 jdolecek {
1610 1.26 cegger struct atppc_softc *atppc = device_private(dev);
1611 1.9 drochner struct atppc_handler_node *callback;
1612 1.1 jdolecek int rval = EINVAL;
1613 1.1 jdolecek int s;
1614 1.1 jdolecek
1615 1.1 jdolecek s = splatppc();
1616 1.1 jdolecek ATPPC_LOCK(atppc);
1617 1.15 drochner
1618 1.9 drochner if (SLIST_EMPTY(&(atppc->sc_handler_listhead)))
1619 1.1 jdolecek panic("%s(%s): attempt to remove handler from empty list.\n",
1620 1.25 cegger __func__, device_xname(dev));
1621 1.1 jdolecek
1622 1.1 jdolecek /* Search list for handler */
1623 1.1 jdolecek SLIST_FOREACH(callback, &(atppc->sc_handler_listhead), entries) {
1624 1.9 drochner if (callback->func == handler) {
1625 1.9 drochner SLIST_REMOVE(&(atppc->sc_handler_listhead), callback,
1626 1.1 jdolecek atppc_handler_node, entries);
1627 1.1 jdolecek free(callback, M_DEVBUF);
1628 1.1 jdolecek rval = 0;
1629 1.1 jdolecek break;
1630 1.1 jdolecek }
1631 1.1 jdolecek }
1632 1.1 jdolecek
1633 1.1 jdolecek ATPPC_UNLOCK(atppc);
1634 1.1 jdolecek splx(s);
1635 1.15 drochner
1636 1.1 jdolecek return rval;
1637 1.1 jdolecek }
1638 1.1 jdolecek
1639 1.1 jdolecek /* Utility functions */
1640 1.1 jdolecek
1641 1.1 jdolecek
1642 1.9 drochner /*
1643 1.9 drochner * Functions that read bytes from port into buffer: called from interrupt
1644 1.9 drochner * handler depending on current chipset mode and cause of interrupt. Return
1645 1.1 jdolecek * value: number of bytes moved.
1646 1.1 jdolecek */
1647 1.1 jdolecek
1648 1.1 jdolecek /* Only the lower 4 bits of the final value are valid */
1649 1.1 jdolecek #define nibble2char(s) ((((s) & ~nACK) >> 3) | (~(s) & nBUSY) >> 4)
1650 1.1 jdolecek
1651 1.9 drochner /* Read bytes in nibble mode */
1652 1.9 drochner static void
1653 1.9 drochner atppc_nibble_read(struct atppc_softc *atppc)
1654 1.1 jdolecek {
1655 1.1 jdolecek int i;
1656 1.1 jdolecek u_int8_t nibble[2];
1657 1.1 jdolecek u_int8_t ctr;
1658 1.1 jdolecek u_int8_t str;
1659 1.1 jdolecek
1660 1.1 jdolecek /* Enable interrupts if needed */
1661 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
1662 1.1 jdolecek ctr = atppc_r_ctr(atppc);
1663 1.1 jdolecek atppc_barrier_r(atppc);
1664 1.9 drochner if (!(ctr & IRQENABLE)) {
1665 1.1 jdolecek ctr |= IRQENABLE;
1666 1.1 jdolecek atppc_w_ctr(atppc, ctr);
1667 1.1 jdolecek atppc_barrier_w(atppc);
1668 1.1 jdolecek }
1669 1.1 jdolecek }
1670 1.15 drochner
1671 1.9 drochner while (atppc->sc_inbstart < (atppc->sc_inb + atppc->sc_inb_nbytes)) {
1672 1.1 jdolecek /* Check if device has data to send in idle phase */
1673 1.1 jdolecek str = atppc_r_str(atppc);
1674 1.1 jdolecek atppc_barrier_r(atppc);
1675 1.9 drochner if (str & nDATAVAIL) {
1676 1.1 jdolecek return;
1677 1.1 jdolecek }
1678 1.1 jdolecek
1679 1.1 jdolecek /* Nibble-mode handshake transfer */
1680 1.9 drochner for (i = 0; i < 2; i++) {
1681 1.1 jdolecek /* Event 7 - ready to take data (HOSTBUSY low) */
1682 1.1 jdolecek ctr = atppc_r_ctr(atppc);
1683 1.1 jdolecek atppc_barrier_r(atppc);
1684 1.1 jdolecek ctr |= HOSTBUSY;
1685 1.9 drochner atppc_w_ctr(atppc, ctr);
1686 1.1 jdolecek atppc_barrier_w(atppc);
1687 1.1 jdolecek
1688 1.1 jdolecek /* Event 8 - peripheral writes the first nibble */
1689 1.1 jdolecek
1690 1.1 jdolecek /* Event 9 - peripheral set nAck low */
1691 1.1 jdolecek atppc->sc_inerr = atppc_poll_str(atppc, 0, PTRCLK);
1692 1.9 drochner if (atppc->sc_inerr)
1693 1.1 jdolecek return;
1694 1.1 jdolecek
1695 1.1 jdolecek /* read nibble */
1696 1.1 jdolecek nibble[i] = atppc_r_str(atppc);
1697 1.1 jdolecek
1698 1.1 jdolecek /* Event 10 - ack, nibble received */
1699 1.1 jdolecek ctr &= ~HOSTBUSY;
1700 1.9 drochner atppc_w_ctr(atppc, ctr);
1701 1.1 jdolecek
1702 1.1 jdolecek /* Event 11 - wait ack from peripherial */
1703 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR)
1704 1.9 drochner atppc->sc_inerr = atppc_wait_interrupt(atppc,
1705 1.1 jdolecek atppc->sc_inb, ATPPC_IRQ_nACK);
1706 1.1 jdolecek else
1707 1.9 drochner atppc->sc_inerr = atppc_poll_str(atppc, PTRCLK,
1708 1.1 jdolecek PTRCLK);
1709 1.9 drochner if (atppc->sc_inerr)
1710 1.1 jdolecek return;
1711 1.1 jdolecek }
1712 1.1 jdolecek
1713 1.1 jdolecek /* Store byte transfered */
1714 1.1 jdolecek *(atppc->sc_inbstart) = ((nibble2char(nibble[1]) << 4) & 0xf0) |
1715 1.1 jdolecek (nibble2char(nibble[0]) & 0x0f);
1716 1.9 drochner atppc->sc_inbstart++;
1717 1.1 jdolecek }
1718 1.1 jdolecek }
1719 1.1 jdolecek
1720 1.1 jdolecek /* Read bytes in bidirectional mode */
1721 1.9 drochner static void
1722 1.1 jdolecek atppc_byte_read(struct atppc_softc * const atppc)
1723 1.1 jdolecek {
1724 1.1 jdolecek u_int8_t ctr;
1725 1.1 jdolecek u_int8_t str;
1726 1.1 jdolecek
1727 1.1 jdolecek /* Check direction bit */
1728 1.9 drochner ctr = atppc_r_ctr(atppc);
1729 1.1 jdolecek atppc_barrier_r(atppc);
1730 1.9 drochner if (!(ctr & PCD)) {
1731 1.1 jdolecek ATPPC_DPRINTF(("%s: byte-mode read attempted without direction "
1732 1.26 cegger "bit set.", device_xname(atppc->sc_dev)));
1733 1.1 jdolecek atppc->sc_inerr = ENODEV;
1734 1.1 jdolecek return;
1735 1.1 jdolecek }
1736 1.1 jdolecek /* Enable interrupts if needed */
1737 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
1738 1.9 drochner if (!(ctr & IRQENABLE)) {
1739 1.1 jdolecek ctr |= IRQENABLE;
1740 1.1 jdolecek atppc_w_ctr(atppc, ctr);
1741 1.1 jdolecek atppc_barrier_w(atppc);
1742 1.1 jdolecek }
1743 1.1 jdolecek }
1744 1.15 drochner
1745 1.1 jdolecek /* Byte-mode handshake transfer */
1746 1.9 drochner while (atppc->sc_inbstart < (atppc->sc_inb + atppc->sc_inb_nbytes)) {
1747 1.1 jdolecek /* Check if device has data to send */
1748 1.1 jdolecek str = atppc_r_str(atppc);
1749 1.1 jdolecek atppc_barrier_r(atppc);
1750 1.9 drochner if (str & nDATAVAIL) {
1751 1.1 jdolecek return;
1752 1.1 jdolecek }
1753 1.1 jdolecek
1754 1.1 jdolecek /* Event 7 - ready to take data (nAUTO low) */
1755 1.1 jdolecek ctr |= HOSTBUSY;
1756 1.9 drochner atppc_w_ctr(atppc, ctr);
1757 1.1 jdolecek atppc_barrier_w(atppc);
1758 1.1 jdolecek
1759 1.1 jdolecek /* Event 9 - peripheral set nAck low */
1760 1.1 jdolecek atppc->sc_inerr = atppc_poll_str(atppc, 0, PTRCLK);
1761 1.9 drochner if (atppc->sc_inerr)
1762 1.1 jdolecek return;
1763 1.1 jdolecek
1764 1.1 jdolecek /* Store byte transfered */
1765 1.1 jdolecek *(atppc->sc_inbstart) = atppc_r_dtr(atppc);
1766 1.1 jdolecek atppc_barrier_r(atppc);
1767 1.1 jdolecek
1768 1.1 jdolecek /* Event 10 - data received, can't accept more */
1769 1.1 jdolecek ctr &= ~HOSTBUSY;
1770 1.9 drochner atppc_w_ctr(atppc, ctr);
1771 1.1 jdolecek atppc_barrier_w(atppc);
1772 1.1 jdolecek
1773 1.1 jdolecek /* Event 11 - peripheral ack */
1774 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR)
1775 1.9 drochner atppc->sc_inerr = atppc_wait_interrupt(atppc,
1776 1.1 jdolecek atppc->sc_inb, ATPPC_IRQ_nACK);
1777 1.1 jdolecek else
1778 1.1 jdolecek atppc->sc_inerr = atppc_poll_str(atppc, PTRCLK, PTRCLK);
1779 1.9 drochner if (atppc->sc_inerr)
1780 1.1 jdolecek return;
1781 1.15 drochner
1782 1.1 jdolecek /* Event 16 - strobe */
1783 1.1 jdolecek str |= HOSTCLK;
1784 1.9 drochner atppc_w_str(atppc, str);
1785 1.1 jdolecek atppc_barrier_w(atppc);
1786 1.1 jdolecek DELAY(1);
1787 1.1 jdolecek str &= ~HOSTCLK;
1788 1.9 drochner atppc_w_str(atppc, str);
1789 1.1 jdolecek atppc_barrier_w(atppc);
1790 1.1 jdolecek
1791 1.1 jdolecek /* Update counter */
1792 1.1 jdolecek atppc->sc_inbstart++;
1793 1.1 jdolecek }
1794 1.1 jdolecek }
1795 1.1 jdolecek
1796 1.1 jdolecek /* Read bytes in EPP mode */
1797 1.9 drochner static void
1798 1.1 jdolecek atppc_epp_read(struct atppc_softc * atppc)
1799 1.1 jdolecek {
1800 1.9 drochner if (atppc->sc_epp == ATPPC_EPP_1_9) {
1801 1.1 jdolecek {
1802 1.1 jdolecek uint8_t str;
1803 1.1 jdolecek int i;
1804 1.1 jdolecek
1805 1.26 cegger atppc_reset_epp_timeout(atppc->sc_dev);
1806 1.9 drochner for (i = 0; i < atppc->sc_inb_nbytes; i++) {
1807 1.1 jdolecek *(atppc->sc_inbstart) = atppc_r_eppD(atppc);
1808 1.1 jdolecek atppc_barrier_r(atppc);
1809 1.1 jdolecek str = atppc_r_str(atppc);
1810 1.1 jdolecek atppc_barrier_r(atppc);
1811 1.9 drochner if (str & TIMEOUT) {
1812 1.1 jdolecek atppc->sc_inerr = EIO;
1813 1.1 jdolecek break;
1814 1.1 jdolecek }
1815 1.1 jdolecek atppc->sc_inbstart++;
1816 1.1 jdolecek }
1817 1.1 jdolecek }
1818 1.9 drochner } else {
1819 1.1 jdolecek /* Read data block from EPP data register */
1820 1.9 drochner atppc_r_eppD_multi(atppc, atppc->sc_inbstart,
1821 1.1 jdolecek atppc->sc_inb_nbytes);
1822 1.1 jdolecek atppc_barrier_r(atppc);
1823 1.1 jdolecek /* Update buffer position, byte count and counter */
1824 1.1 jdolecek atppc->sc_inbstart += atppc->sc_inb_nbytes;
1825 1.1 jdolecek }
1826 1.1 jdolecek
1827 1.1 jdolecek return;
1828 1.1 jdolecek }
1829 1.1 jdolecek
1830 1.9 drochner /* Read bytes in ECP mode */
1831 1.9 drochner static void
1832 1.9 drochner atppc_ecp_read(struct atppc_softc *atppc)
1833 1.1 jdolecek {
1834 1.1 jdolecek u_int8_t ecr;
1835 1.1 jdolecek u_int8_t ctr;
1836 1.1 jdolecek u_int8_t str;
1837 1.1 jdolecek const unsigned char ctr_sav = atppc_r_ctr(atppc);
1838 1.1 jdolecek const unsigned char ecr_sav = atppc_r_ecr(atppc);
1839 1.1 jdolecek unsigned int worklen;
1840 1.1 jdolecek
1841 1.1 jdolecek /* Check direction bit */
1842 1.9 drochner ctr = ctr_sav;
1843 1.1 jdolecek atppc_barrier_r(atppc);
1844 1.9 drochner if (!(ctr & PCD)) {
1845 1.1 jdolecek ATPPC_DPRINTF(("%s: ecp-mode read attempted without direction "
1846 1.25 cegger "bit set.", device_xname(atppc->sc_dev)));
1847 1.1 jdolecek atppc->sc_inerr = ENODEV;
1848 1.1 jdolecek goto end;
1849 1.1 jdolecek }
1850 1.1 jdolecek
1851 1.1 jdolecek /* Clear device request if any */
1852 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR)
1853 1.9 drochner atppc->sc_irqstat &= ~ATPPC_IRQ_nFAULT;
1854 1.15 drochner
1855 1.9 drochner while (atppc->sc_inbstart < (atppc->sc_inb + atppc->sc_inb_nbytes)) {
1856 1.1 jdolecek ecr = atppc_r_ecr(atppc);
1857 1.1 jdolecek atppc_barrier_r(atppc);
1858 1.9 drochner if (ecr & ATPPC_FIFO_EMPTY) {
1859 1.9 drochner /* Check for invalid state */
1860 1.9 drochner if (ecr & ATPPC_FIFO_FULL) {
1861 1.21 drochner atppc_ecp_read_error(atppc);
1862 1.1 jdolecek break;
1863 1.1 jdolecek }
1864 1.15 drochner
1865 1.1 jdolecek /* Check if device has data to send */
1866 1.1 jdolecek str = atppc_r_str(atppc);
1867 1.1 jdolecek atppc_barrier_r(atppc);
1868 1.9 drochner if (str & nDATAVAIL) {
1869 1.1 jdolecek break;
1870 1.1 jdolecek }
1871 1.15 drochner
1872 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
1873 1.1 jdolecek /* Enable interrupts */
1874 1.1 jdolecek ecr &= ~ATPPC_SERVICE_INTR;
1875 1.1 jdolecek atppc_w_ecr(atppc, ecr);
1876 1.1 jdolecek atppc_barrier_w(atppc);
1877 1.1 jdolecek /* Wait for FIFO to fill */
1878 1.9 drochner atppc->sc_inerr = atppc_wait_interrupt(atppc,
1879 1.1 jdolecek atppc->sc_inb, ATPPC_IRQ_FIFO);
1880 1.9 drochner if (atppc->sc_inerr)
1881 1.1 jdolecek break;
1882 1.9 drochner } else {
1883 1.1 jdolecek DELAY(1);
1884 1.1 jdolecek }
1885 1.1 jdolecek continue;
1886 1.1 jdolecek }
1887 1.9 drochner else if (ecr & ATPPC_FIFO_FULL) {
1888 1.1 jdolecek /* Transfer sc_fifo bytes */
1889 1.1 jdolecek worklen = atppc->sc_fifo;
1890 1.1 jdolecek }
1891 1.9 drochner else if (ecr & ATPPC_SERVICE_INTR) {
1892 1.1 jdolecek /* Transfer sc_rthr bytes */
1893 1.1 jdolecek worklen = atppc->sc_rthr;
1894 1.9 drochner } else {
1895 1.1 jdolecek /* At least one byte is in the FIFO */
1896 1.1 jdolecek worklen = 1;
1897 1.1 jdolecek }
1898 1.1 jdolecek
1899 1.9 drochner if ((atppc->sc_use & ATPPC_USE_INTR) &&
1900 1.1 jdolecek (atppc->sc_use & ATPPC_USE_DMA)) {
1901 1.1 jdolecek
1902 1.1 jdolecek atppc_ecp_read_dma(atppc, &worklen, ecr);
1903 1.9 drochner } else {
1904 1.1 jdolecek atppc_ecp_read_pio(atppc, &worklen, ecr);
1905 1.1 jdolecek }
1906 1.15 drochner
1907 1.9 drochner if (atppc->sc_inerr) {
1908 1.21 drochner atppc_ecp_read_error(atppc);
1909 1.1 jdolecek break;
1910 1.1 jdolecek }
1911 1.1 jdolecek
1912 1.1 jdolecek /* Update counter */
1913 1.1 jdolecek atppc->sc_inbstart += worklen;
1914 1.1 jdolecek }
1915 1.1 jdolecek end:
1916 1.1 jdolecek atppc_w_ctr(atppc, ctr_sav);
1917 1.1 jdolecek atppc_w_ecr(atppc, ecr_sav);
1918 1.1 jdolecek atppc_barrier_w(atppc);
1919 1.1 jdolecek }
1920 1.1 jdolecek
1921 1.9 drochner /* Read bytes in ECP mode using DMA transfers */
1922 1.9 drochner static void
1923 1.9 drochner atppc_ecp_read_dma(struct atppc_softc *atppc, unsigned int *length,
1924 1.1 jdolecek unsigned char ecr)
1925 1.1 jdolecek {
1926 1.1 jdolecek /* Limit transfer to maximum DMA size and start it */
1927 1.1 jdolecek *length = min(*length, atppc->sc_dma_maxsize);
1928 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_INIT;
1929 1.9 drochner atppc->sc_dma_start(atppc, atppc->sc_inbstart, *length,
1930 1.1 jdolecek ATPPC_DMA_MODE_READ);
1931 1.15 drochner
1932 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_STARTED;
1933 1.1 jdolecek
1934 1.1 jdolecek /* Enable interrupts, DMA */
1935 1.1 jdolecek ecr &= ~ATPPC_SERVICE_INTR;
1936 1.1 jdolecek ecr |= ATPPC_ENABLE_DMA;
1937 1.1 jdolecek atppc_w_ecr(atppc, ecr);
1938 1.1 jdolecek atppc_barrier_w(atppc);
1939 1.1 jdolecek
1940 1.1 jdolecek /* Wait for DMA completion */
1941 1.9 drochner atppc->sc_inerr = atppc_wait_interrupt(atppc, atppc->sc_inb,
1942 1.1 jdolecek ATPPC_IRQ_DMA);
1943 1.9 drochner if (atppc->sc_inerr)
1944 1.1 jdolecek return;
1945 1.15 drochner
1946 1.1 jdolecek /* Get register value recorded by interrupt handler */
1947 1.9 drochner ecr = atppc->sc_ecr_intr;
1948 1.1 jdolecek /* Clear DMA programming */
1949 1.1 jdolecek atppc->sc_dma_finish(atppc);
1950 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_COMPLETE;
1951 1.1 jdolecek /* Disable DMA */
1952 1.1 jdolecek ecr &= ~ATPPC_ENABLE_DMA;
1953 1.1 jdolecek atppc_w_ecr(atppc, ecr);
1954 1.1 jdolecek atppc_barrier_w(atppc);
1955 1.1 jdolecek }
1956 1.1 jdolecek
1957 1.9 drochner /* Read bytes in ECP mode using PIO transfers */
1958 1.9 drochner static void
1959 1.9 drochner atppc_ecp_read_pio(struct atppc_softc *atppc, unsigned int *length,
1960 1.1 jdolecek unsigned char ecr)
1961 1.1 jdolecek {
1962 1.1 jdolecek /* Disable DMA */
1963 1.1 jdolecek ecr &= ~ATPPC_ENABLE_DMA;
1964 1.1 jdolecek atppc_w_ecr(atppc, ecr);
1965 1.1 jdolecek atppc_barrier_w(atppc);
1966 1.15 drochner
1967 1.1 jdolecek /* Read from FIFO */
1968 1.1 jdolecek atppc_r_fifo_multi(atppc, atppc->sc_inbstart, *length);
1969 1.1 jdolecek }
1970 1.1 jdolecek
1971 1.1 jdolecek /* Handle errors for ECP reads */
1972 1.9 drochner static void
1973 1.21 drochner atppc_ecp_read_error(struct atppc_softc *atppc)
1974 1.1 jdolecek {
1975 1.1 jdolecek unsigned char ecr = atppc_r_ecr(atppc);
1976 1.1 jdolecek
1977 1.1 jdolecek /* Abort DMA if not finished */
1978 1.9 drochner if (atppc->sc_dmastat == ATPPC_DMA_STARTED) {
1979 1.1 jdolecek atppc->sc_dma_abort(atppc);
1980 1.1 jdolecek ATPPC_DPRINTF(("%s: DMA interrupted.\n", __func__));
1981 1.1 jdolecek }
1982 1.1 jdolecek
1983 1.1 jdolecek /* Check for invalid states */
1984 1.9 drochner if ((ecr & ATPPC_FIFO_EMPTY) && (ecr & ATPPC_FIFO_FULL)) {
1985 1.9 drochner ATPPC_DPRINTF(("%s: FIFO full+empty bits set.\n", __func__));
1986 1.1 jdolecek ATPPC_DPRINTF(("%s: reseting FIFO.\n", __func__));
1987 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
1988 1.1 jdolecek atppc_barrier_w(atppc);
1989 1.1 jdolecek }
1990 1.1 jdolecek }
1991 1.1 jdolecek
1992 1.9 drochner /*
1993 1.9 drochner * Functions that write bytes to port from buffer: called from atppc_write()
1994 1.1 jdolecek * function depending on current chipset mode. Returns number of bytes moved.
1995 1.1 jdolecek */
1996 1.1 jdolecek
1997 1.1 jdolecek /* Write bytes in std/bidirectional mode */
1998 1.9 drochner static void
1999 1.1 jdolecek atppc_std_write(struct atppc_softc * const atppc)
2000 1.1 jdolecek {
2001 1.1 jdolecek unsigned int timecount;
2002 1.1 jdolecek unsigned char ctr;
2003 1.1 jdolecek
2004 1.9 drochner ctr = atppc_r_ctr(atppc);
2005 1.1 jdolecek atppc_barrier_r(atppc);
2006 1.1 jdolecek /* Enable interrupts if needed */
2007 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
2008 1.9 drochner if (!(ctr & IRQENABLE)) {
2009 1.1 jdolecek ctr |= IRQENABLE;
2010 1.1 jdolecek atppc_w_ctr(atppc, ctr);
2011 1.1 jdolecek atppc_barrier_w(atppc);
2012 1.1 jdolecek }
2013 1.1 jdolecek }
2014 1.1 jdolecek
2015 1.9 drochner while (atppc->sc_outbstart < (atppc->sc_outb + atppc->sc_outb_nbytes)) {
2016 1.1 jdolecek /* Wait for peripheral to become ready for MAXBUSYWAIT */
2017 1.1 jdolecek atppc->sc_outerr = atppc_poll_str(atppc, SPP_READY, SPP_MASK);
2018 1.9 drochner if (atppc->sc_outerr)
2019 1.1 jdolecek return;
2020 1.1 jdolecek
2021 1.1 jdolecek /* Put data in data register */
2022 1.1 jdolecek atppc_w_dtr(atppc, *(atppc->sc_outbstart));
2023 1.1 jdolecek atppc_barrier_w(atppc);
2024 1.1 jdolecek DELAY(1);
2025 1.1 jdolecek
2026 1.1 jdolecek /* Pulse strobe to indicate valid data on lines */
2027 1.1 jdolecek ctr |= STROBE;
2028 1.1 jdolecek atppc_w_ctr(atppc, ctr);
2029 1.1 jdolecek atppc_barrier_w(atppc);
2030 1.1 jdolecek DELAY(1);
2031 1.1 jdolecek ctr &= ~STROBE;
2032 1.1 jdolecek atppc_w_ctr(atppc, ctr);
2033 1.1 jdolecek atppc_barrier_w(atppc);
2034 1.1 jdolecek
2035 1.1 jdolecek /* Wait for nACK for MAXBUSYWAIT */
2036 1.1 jdolecek timecount = 0;
2037 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
2038 1.9 drochner atppc->sc_outerr = atppc_wait_interrupt(atppc,
2039 1.1 jdolecek atppc->sc_outb, ATPPC_IRQ_nACK);
2040 1.9 drochner if (atppc->sc_outerr)
2041 1.1 jdolecek return;
2042 1.9 drochner } else {
2043 1.1 jdolecek /* Try to catch the pulsed acknowledgement */
2044 1.1 jdolecek atppc->sc_outerr = atppc_poll_str(atppc, 0, nACK);
2045 1.9 drochner if (atppc->sc_outerr)
2046 1.1 jdolecek return;
2047 1.1 jdolecek atppc->sc_outerr = atppc_poll_str(atppc, nACK, nACK);
2048 1.9 drochner if (atppc->sc_outerr)
2049 1.1 jdolecek return;
2050 1.1 jdolecek }
2051 1.1 jdolecek
2052 1.1 jdolecek /* Update buffer position, byte count and counter */
2053 1.1 jdolecek atppc->sc_outbstart++;
2054 1.1 jdolecek }
2055 1.1 jdolecek }
2056 1.1 jdolecek
2057 1.1 jdolecek
2058 1.1 jdolecek /* Write bytes in EPP mode */
2059 1.9 drochner static void
2060 1.9 drochner atppc_epp_write(struct atppc_softc *atppc)
2061 1.1 jdolecek {
2062 1.9 drochner if (atppc->sc_epp == ATPPC_EPP_1_9) {
2063 1.1 jdolecek {
2064 1.1 jdolecek uint8_t str;
2065 1.1 jdolecek int i;
2066 1.1 jdolecek
2067 1.26 cegger atppc_reset_epp_timeout(atppc->sc_dev);
2068 1.9 drochner for (i = 0; i < atppc->sc_outb_nbytes; i++) {
2069 1.1 jdolecek atppc_w_eppD(atppc, *(atppc->sc_outbstart));
2070 1.1 jdolecek atppc_barrier_w(atppc);
2071 1.1 jdolecek str = atppc_r_str(atppc);
2072 1.1 jdolecek atppc_barrier_r(atppc);
2073 1.9 drochner if (str & TIMEOUT) {
2074 1.1 jdolecek atppc->sc_outerr = EIO;
2075 1.1 jdolecek break;
2076 1.1 jdolecek }
2077 1.1 jdolecek atppc->sc_outbstart++;
2078 1.1 jdolecek }
2079 1.1 jdolecek }
2080 1.9 drochner } else {
2081 1.1 jdolecek /* Write data block to EPP data register */
2082 1.9 drochner atppc_w_eppD_multi(atppc, atppc->sc_outbstart,
2083 1.1 jdolecek atppc->sc_outb_nbytes);
2084 1.1 jdolecek atppc_barrier_w(atppc);
2085 1.1 jdolecek /* Update buffer position, byte count and counter */
2086 1.1 jdolecek atppc->sc_outbstart += atppc->sc_outb_nbytes;
2087 1.1 jdolecek }
2088 1.1 jdolecek
2089 1.1 jdolecek return;
2090 1.1 jdolecek }
2091 1.1 jdolecek
2092 1.1 jdolecek
2093 1.1 jdolecek /* Write bytes in ECP/Fast Centronics mode */
2094 1.9 drochner static void
2095 1.1 jdolecek atppc_fifo_write(struct atppc_softc * const atppc)
2096 1.1 jdolecek {
2097 1.1 jdolecek unsigned char ctr;
2098 1.1 jdolecek unsigned char ecr;
2099 1.1 jdolecek const unsigned char ctr_sav = atppc_r_ctr(atppc);
2100 1.1 jdolecek const unsigned char ecr_sav = atppc_r_ecr(atppc);
2101 1.15 drochner
2102 1.1 jdolecek ctr = ctr_sav;
2103 1.1 jdolecek ecr = ecr_sav;
2104 1.1 jdolecek atppc_barrier_r(atppc);
2105 1.1 jdolecek
2106 1.1 jdolecek /* Reset and flush FIFO */
2107 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
2108 1.1 jdolecek atppc_barrier_w(atppc);
2109 1.1 jdolecek /* Disable nAck interrupts and initialize port bits */
2110 1.1 jdolecek ctr &= ~(IRQENABLE | STROBE | AUTOFEED);
2111 1.1 jdolecek atppc_w_ctr(atppc, ctr);
2112 1.1 jdolecek atppc_barrier_w(atppc);
2113 1.1 jdolecek /* Restore mode */
2114 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2115 1.1 jdolecek atppc_barrier_w(atppc);
2116 1.1 jdolecek
2117 1.1 jdolecek /* DMA or Programmed IO */
2118 1.9 drochner if ((atppc->sc_use & ATPPC_USE_DMA) &&
2119 1.9 drochner (atppc->sc_use & ATPPC_USE_INTR)) {
2120 1.15 drochner
2121 1.1 jdolecek atppc_fifo_write_dma(atppc, ecr, ctr);
2122 1.9 drochner } else {
2123 1.1 jdolecek atppc_fifo_write_pio(atppc, ecr, ctr);
2124 1.1 jdolecek }
2125 1.15 drochner
2126 1.1 jdolecek /* Restore original register values */
2127 1.1 jdolecek atppc_w_ctr(atppc, ctr_sav);
2128 1.1 jdolecek atppc_w_ecr(atppc, ecr_sav);
2129 1.1 jdolecek atppc_barrier_w(atppc);
2130 1.1 jdolecek }
2131 1.1 jdolecek
2132 1.9 drochner static void
2133 1.9 drochner atppc_fifo_write_dma(struct atppc_softc * const atppc, unsigned char ecr,
2134 1.1 jdolecek unsigned char ctr)
2135 1.1 jdolecek {
2136 1.1 jdolecek unsigned int len;
2137 1.1 jdolecek unsigned int worklen;
2138 1.1 jdolecek
2139 1.9 drochner for (len = (atppc->sc_outb + atppc->sc_outb_nbytes) -
2140 1.9 drochner atppc->sc_outbstart; len > 0; len = (atppc->sc_outb +
2141 1.1 jdolecek atppc->sc_outb_nbytes) - atppc->sc_outbstart) {
2142 1.15 drochner
2143 1.1 jdolecek /* Wait for device to become ready */
2144 1.1 jdolecek atppc->sc_outerr = atppc_poll_str(atppc, SPP_READY, SPP_MASK);
2145 1.9 drochner if (atppc->sc_outerr)
2146 1.1 jdolecek return;
2147 1.15 drochner
2148 1.1 jdolecek /* Reset chipset for next DMA transfer */
2149 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
2150 1.1 jdolecek atppc_barrier_w(atppc);
2151 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2152 1.1 jdolecek atppc_barrier_w(atppc);
2153 1.15 drochner
2154 1.1 jdolecek /* Limit transfer to maximum DMA size and start it */
2155 1.10 jdolecek worklen = min(len, atppc->sc_dma_maxsize);
2156 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_INIT;
2157 1.1 jdolecek atppc->sc_dma_start(atppc, atppc->sc_outbstart,
2158 1.1 jdolecek worklen, ATPPC_DMA_MODE_WRITE);
2159 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_STARTED;
2160 1.1 jdolecek
2161 1.1 jdolecek /* Enable interrupts, DMA */
2162 1.1 jdolecek ecr &= ~ATPPC_SERVICE_INTR;
2163 1.1 jdolecek ecr |= ATPPC_ENABLE_DMA;
2164 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2165 1.1 jdolecek atppc_barrier_w(atppc);
2166 1.1 jdolecek
2167 1.1 jdolecek /* Wait for DMA completion */
2168 1.9 drochner atppc->sc_outerr = atppc_wait_interrupt(atppc, atppc->sc_outb,
2169 1.1 jdolecek ATPPC_IRQ_DMA);
2170 1.9 drochner if (atppc->sc_outerr) {
2171 1.9 drochner atppc_fifo_write_error(atppc, worklen);
2172 1.1 jdolecek return;
2173 1.1 jdolecek }
2174 1.1 jdolecek /* Get register value recorded by interrupt handler */
2175 1.9 drochner ecr = atppc->sc_ecr_intr;
2176 1.1 jdolecek /* Clear DMA programming */
2177 1.1 jdolecek atppc->sc_dma_finish(atppc);
2178 1.1 jdolecek atppc->sc_dmastat = ATPPC_DMA_COMPLETE;
2179 1.1 jdolecek /* Disable DMA */
2180 1.1 jdolecek ecr &= ~ATPPC_ENABLE_DMA;
2181 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2182 1.1 jdolecek atppc_barrier_w(atppc);
2183 1.15 drochner
2184 1.1 jdolecek /* Wait for FIFO to empty */
2185 1.9 drochner for (;;) {
2186 1.9 drochner if (ecr & ATPPC_FIFO_EMPTY) {
2187 1.9 drochner if (ecr & ATPPC_FIFO_FULL) {
2188 1.1 jdolecek atppc->sc_outerr = EIO;
2189 1.1 jdolecek atppc_fifo_write_error(atppc, worklen);
2190 1.1 jdolecek return;
2191 1.9 drochner } else {
2192 1.1 jdolecek break;
2193 1.1 jdolecek }
2194 1.1 jdolecek }
2195 1.15 drochner
2196 1.1 jdolecek /* Enable service interrupt */
2197 1.1 jdolecek ecr &= ~ATPPC_SERVICE_INTR;
2198 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2199 1.1 jdolecek atppc_barrier_w(atppc);
2200 1.15 drochner
2201 1.9 drochner atppc->sc_outerr = atppc_wait_interrupt(atppc,
2202 1.1 jdolecek atppc->sc_outb, ATPPC_IRQ_FIFO);
2203 1.9 drochner if (atppc->sc_outerr) {
2204 1.9 drochner atppc_fifo_write_error(atppc, worklen);
2205 1.1 jdolecek return;
2206 1.1 jdolecek }
2207 1.15 drochner
2208 1.1 jdolecek /* Get register value recorded by interrupt handler */
2209 1.9 drochner ecr = atppc->sc_ecr_intr;
2210 1.1 jdolecek }
2211 1.1 jdolecek
2212 1.1 jdolecek /* Update pointer */
2213 1.1 jdolecek atppc->sc_outbstart += worklen;
2214 1.1 jdolecek }
2215 1.1 jdolecek }
2216 1.1 jdolecek
2217 1.9 drochner static void
2218 1.9 drochner atppc_fifo_write_pio(struct atppc_softc * const atppc, unsigned char ecr,
2219 1.1 jdolecek unsigned char ctr)
2220 1.1 jdolecek {
2221 1.1 jdolecek unsigned int len;
2222 1.1 jdolecek unsigned int worklen;
2223 1.1 jdolecek unsigned int timecount;
2224 1.1 jdolecek
2225 1.1 jdolecek /* Disable DMA */
2226 1.1 jdolecek ecr &= ~ATPPC_ENABLE_DMA;
2227 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2228 1.1 jdolecek atppc_barrier_w(atppc);
2229 1.15 drochner
2230 1.9 drochner for (len = (atppc->sc_outb + atppc->sc_outb_nbytes) -
2231 1.9 drochner atppc->sc_outbstart; len > 0; len = (atppc->sc_outb +
2232 1.1 jdolecek atppc->sc_outb_nbytes) - atppc->sc_outbstart) {
2233 1.15 drochner
2234 1.1 jdolecek /* Wait for device to become ready */
2235 1.1 jdolecek atppc->sc_outerr = atppc_poll_str(atppc, SPP_READY, SPP_MASK);
2236 1.9 drochner if (atppc->sc_outerr)
2237 1.1 jdolecek return;
2238 1.15 drochner
2239 1.1 jdolecek /* Limit transfer to minimum of space in FIFO and buffer */
2240 1.1 jdolecek worklen = min(len, atppc->sc_fifo);
2241 1.1 jdolecek
2242 1.1 jdolecek /* Write to FIFO */
2243 1.1 jdolecek atppc_w_fifo_multi(atppc, atppc->sc_outbstart, worklen);
2244 1.1 jdolecek
2245 1.1 jdolecek timecount = 0;
2246 1.9 drochner if (atppc->sc_use & ATPPC_USE_INTR) {
2247 1.1 jdolecek ecr = atppc_r_ecr(atppc);
2248 1.1 jdolecek atppc_barrier_w(atppc);
2249 1.15 drochner
2250 1.1 jdolecek /* Wait for interrupt */
2251 1.9 drochner for (;;) {
2252 1.9 drochner if (ecr & ATPPC_FIFO_EMPTY) {
2253 1.9 drochner if (ecr & ATPPC_FIFO_FULL) {
2254 1.1 jdolecek atppc->sc_outerr = EIO;
2255 1.9 drochner atppc_fifo_write_error(atppc,
2256 1.1 jdolecek worklen);
2257 1.1 jdolecek return;
2258 1.9 drochner } else {
2259 1.1 jdolecek break;
2260 1.1 jdolecek }
2261 1.1 jdolecek }
2262 1.1 jdolecek
2263 1.1 jdolecek /* Enable service interrupt */
2264 1.1 jdolecek ecr &= ~ATPPC_SERVICE_INTR;
2265 1.1 jdolecek atppc_w_ecr(atppc, ecr);
2266 1.1 jdolecek atppc_barrier_w(atppc);
2267 1.15 drochner
2268 1.9 drochner atppc->sc_outerr = atppc_wait_interrupt(atppc,
2269 1.1 jdolecek atppc->sc_outb, ATPPC_IRQ_FIFO);
2270 1.9 drochner if (atppc->sc_outerr) {
2271 1.1 jdolecek atppc_fifo_write_error(atppc, worklen);
2272 1.1 jdolecek return;
2273 1.1 jdolecek }
2274 1.15 drochner
2275 1.1 jdolecek /* Get ECR value saved by interrupt handler */
2276 1.9 drochner ecr = atppc->sc_ecr_intr;
2277 1.1 jdolecek }
2278 1.9 drochner } else {
2279 1.9 drochner for (; timecount < ((MAXBUSYWAIT/hz)*1000000);
2280 1.9 drochner timecount++) {
2281 1.15 drochner
2282 1.1 jdolecek ecr = atppc_r_ecr(atppc);
2283 1.1 jdolecek atppc_barrier_r(atppc);
2284 1.9 drochner if (ecr & ATPPC_FIFO_EMPTY) {
2285 1.9 drochner if (ecr & ATPPC_FIFO_FULL) {
2286 1.1 jdolecek atppc->sc_outerr = EIO;
2287 1.9 drochner atppc_fifo_write_error(atppc,
2288 1.1 jdolecek worklen);
2289 1.1 jdolecek return;
2290 1.9 drochner } else {
2291 1.1 jdolecek break;
2292 1.1 jdolecek }
2293 1.1 jdolecek }
2294 1.1 jdolecek DELAY(1);
2295 1.1 jdolecek }
2296 1.15 drochner
2297 1.9 drochner if (((timecount*hz)/1000000) >= MAXBUSYWAIT) {
2298 1.1 jdolecek atppc->sc_outerr = EIO;
2299 1.9 drochner atppc_fifo_write_error(atppc, worklen);
2300 1.1 jdolecek return;
2301 1.1 jdolecek }
2302 1.1 jdolecek }
2303 1.15 drochner
2304 1.1 jdolecek /* Update pointer */
2305 1.1 jdolecek atppc->sc_outbstart += worklen;
2306 1.1 jdolecek }
2307 1.1 jdolecek }
2308 1.1 jdolecek
2309 1.9 drochner static void
2310 1.9 drochner atppc_fifo_write_error(struct atppc_softc * const atppc,
2311 1.1 jdolecek const unsigned int worklen)
2312 1.1 jdolecek {
2313 1.1 jdolecek unsigned char ecr = atppc_r_ecr(atppc);
2314 1.1 jdolecek
2315 1.1 jdolecek /* Abort DMA if not finished */
2316 1.9 drochner if (atppc->sc_dmastat == ATPPC_DMA_STARTED) {
2317 1.1 jdolecek atppc->sc_dma_abort(atppc);
2318 1.1 jdolecek ATPPC_DPRINTF(("%s: DMA interrupted.\n", __func__));
2319 1.1 jdolecek }
2320 1.1 jdolecek
2321 1.1 jdolecek /* Check for invalid states */
2322 1.9 drochner if ((ecr & ATPPC_FIFO_EMPTY) && (ecr & ATPPC_FIFO_FULL)) {
2323 1.9 drochner ATPPC_DPRINTF(("%s: FIFO full+empty bits set.\n", __func__));
2324 1.9 drochner } else if (!(ecr & ATPPC_FIFO_EMPTY)) {
2325 1.1 jdolecek unsigned char ctr = atppc_r_ctr(atppc);
2326 1.1 jdolecek int bytes_left;
2327 1.1 jdolecek int i;
2328 1.1 jdolecek
2329 1.9 drochner ATPPC_DPRINTF(("%s(%s): FIFO not empty.\n", __func__,
2330 1.26 cegger device_xname(atppc->sc_dev)));
2331 1.15 drochner
2332 1.1 jdolecek /* Drive strobe low to stop data transfer */
2333 1.1 jdolecek ctr &= ~STROBE;
2334 1.1 jdolecek atppc_w_ctr(atppc, ctr);
2335 1.1 jdolecek atppc_barrier_w(atppc);
2336 1.1 jdolecek
2337 1.1 jdolecek /* Determine how many bytes remain in FIFO */
2338 1.9 drochner for (i = 0; i < atppc->sc_fifo; i++) {
2339 1.1 jdolecek atppc_w_fifo(atppc, (unsigned char)i);
2340 1.1 jdolecek ecr = atppc_r_ecr(atppc);
2341 1.1 jdolecek atppc_barrier_r(atppc);
2342 1.9 drochner if (ecr & ATPPC_FIFO_FULL)
2343 1.1 jdolecek break;
2344 1.1 jdolecek }
2345 1.1 jdolecek bytes_left = (atppc->sc_fifo) - (i + 1);
2346 1.9 drochner ATPPC_DPRINTF(("%s: %d bytes left in FIFO.\n", __func__,
2347 1.1 jdolecek bytes_left));
2348 1.15 drochner
2349 1.1 jdolecek /* Update counter */
2350 1.1 jdolecek atppc->sc_outbstart += (worklen - bytes_left);
2351 1.9 drochner } else {
2352 1.1 jdolecek /* Update counter */
2353 1.1 jdolecek atppc->sc_outbstart += worklen;
2354 1.1 jdolecek }
2355 1.1 jdolecek
2356 1.1 jdolecek ATPPC_DPRINTF(("%s: reseting FIFO.\n", __func__));
2357 1.1 jdolecek atppc_w_ecr(atppc, ATPPC_ECR_PS2);
2358 1.1 jdolecek atppc_barrier_w(atppc);
2359 1.1 jdolecek }
2360 1.1 jdolecek
2361 1.9 drochner /*
2362 1.9 drochner * Poll status register using mask and status for MAXBUSYWAIT.
2363 1.1 jdolecek * Returns 0 if device ready, error value otherwise.
2364 1.1 jdolecek */
2365 1.1 jdolecek static int
2366 1.9 drochner atppc_poll_str(const struct atppc_softc * const atppc, const u_int8_t status,
2367 1.1 jdolecek const u_int8_t mask)
2368 1.1 jdolecek {
2369 1.1 jdolecek unsigned int timecount;
2370 1.1 jdolecek u_int8_t str;
2371 1.1 jdolecek int error = EIO;
2372 1.1 jdolecek
2373 1.1 jdolecek /* Wait for str to have status for MAXBUSYWAIT */
2374 1.9 drochner for (timecount = 0; timecount < ((MAXBUSYWAIT/hz)*1000000);
2375 1.1 jdolecek timecount++) {
2376 1.15 drochner
2377 1.1 jdolecek str = atppc_r_str(atppc);
2378 1.1 jdolecek atppc_barrier_r(atppc);
2379 1.9 drochner if ((str & mask) == status) {
2380 1.1 jdolecek error = 0;
2381 1.1 jdolecek break;
2382 1.1 jdolecek }
2383 1.1 jdolecek DELAY(1);
2384 1.1 jdolecek }
2385 1.1 jdolecek
2386 1.1 jdolecek return error;
2387 1.1 jdolecek }
2388 1.1 jdolecek
2389 1.1 jdolecek /* Wait for interrupt for MAXBUSYWAIT: returns 0 if acknowledge received. */
2390 1.1 jdolecek static int
2391 1.23 christos atppc_wait_interrupt(struct atppc_softc * const atppc, const void *where,
2392 1.1 jdolecek const u_int8_t irqstat)
2393 1.1 jdolecek {
2394 1.1 jdolecek int error = EIO;
2395 1.1 jdolecek
2396 1.1 jdolecek atppc->sc_irqstat &= ~irqstat;
2397 1.15 drochner
2398 1.1 jdolecek /* Wait for interrupt for MAXBUSYWAIT */
2399 1.9 drochner error = ltsleep(where, PPBUSPRI | PCATCH, __func__, MAXBUSYWAIT,
2400 1.9 drochner ATPPC_SC_LOCK(atppc));
2401 1.15 drochner
2402 1.9 drochner if (!(error) && (atppc->sc_irqstat & irqstat)) {
2403 1.1 jdolecek atppc->sc_irqstat &= ~irqstat;
2404 1.1 jdolecek error = 0;
2405 1.1 jdolecek }
2406 1.1 jdolecek
2407 1.1 jdolecek return error;
2408 1.1 jdolecek }
2409