ppbus_base.c revision 1.3 1 1.3 bjh21 /* $NetBSD: ppbus_base.c,v 1.3 2004/01/22 01:13:21 bjh21 Exp $ */
2 1.2 bjh21
3 1.1 jdolecek /*-
4 1.1 jdolecek * Copyright (c) 1997, 1998, 1999 Nicolas Souchu
5 1.1 jdolecek * All rights reserved.
6 1.1 jdolecek *
7 1.1 jdolecek * Redistribution and use in source and binary forms, with or without
8 1.1 jdolecek * modification, are permitted provided that the following conditions
9 1.1 jdolecek * are met:
10 1.1 jdolecek * 1. Redistributions of source code must retain the above copyright
11 1.1 jdolecek * notice, this list of conditions and the following disclaimer.
12 1.1 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jdolecek * notice, this list of conditions and the following disclaimer in the
14 1.1 jdolecek * documentation and/or other materials provided with the distribution.
15 1.1 jdolecek *
16 1.1 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.1 jdolecek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 jdolecek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 jdolecek * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 jdolecek * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 jdolecek * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 jdolecek * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 jdolecek * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 jdolecek * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jdolecek * SUCH DAMAGE.
27 1.1 jdolecek *
28 1.1 jdolecek * $FreeBSD: src/sys/dev/ppbus/ppb_base.c,v 1.10.2.1 2000/08/01 23:26:26 n_hibma Exp $
29 1.1 jdolecek *
30 1.1 jdolecek */
31 1.1 jdolecek #include "opt_ppbus_1284.h"
32 1.1 jdolecek #include "opt_ppbus.h"
33 1.1 jdolecek
34 1.1 jdolecek #include <sys/param.h>
35 1.1 jdolecek #include <sys/kernel.h>
36 1.3 bjh21 #include <sys/malloc.h>
37 1.1 jdolecek #include <sys/proc.h>
38 1.1 jdolecek #include <sys/lock.h>
39 1.1 jdolecek #include <sys/systm.h>
40 1.1 jdolecek
41 1.1 jdolecek #include <dev/ppbus/ppbus_1284.h>
42 1.1 jdolecek #include <dev/ppbus/ppbus_conf.h>
43 1.1 jdolecek #include <dev/ppbus/ppbus_base.h>
44 1.1 jdolecek #include <dev/ppbus/ppbus_device.h>
45 1.1 jdolecek #include <dev/ppbus/ppbus_io.h>
46 1.1 jdolecek #include <dev/ppbus/ppbus_var.h>
47 1.1 jdolecek
48 1.1 jdolecek /* Utility functions */
49 1.1 jdolecek static char * search_token(char *, int, char *);
50 1.1 jdolecek
51 1.1 jdolecek
52 1.1 jdolecek /* Perform general ppbus I/O request */
53 1.1 jdolecek int
54 1.1 jdolecek ppbus_io(struct device * dev, int iop, u_char * addr, int cnt, u_char byte)
55 1.1 jdolecek {
56 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
57 1.1 jdolecek return (bus->ppbus_io(dev->dv_parent, iop, addr, cnt, byte));
58 1.1 jdolecek }
59 1.1 jdolecek
60 1.1 jdolecek /* Execute microsequence */
61 1.1 jdolecek int
62 1.1 jdolecek ppbus_exec_microseq(struct device * dev, struct ppbus_microseq ** sequence)
63 1.1 jdolecek {
64 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
65 1.1 jdolecek return (bus->ppbus_exec_microseq(dev->dv_parent, sequence));
66 1.1 jdolecek }
67 1.1 jdolecek
68 1.1 jdolecek /* Read instance variables of ppbus */
69 1.1 jdolecek int
70 1.1 jdolecek ppbus_read_ivar(struct device * dev, int index, unsigned int * val)
71 1.1 jdolecek
72 1.1 jdolecek {
73 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
74 1.1 jdolecek
75 1.1 jdolecek switch (index) {
76 1.1 jdolecek case PPBUS_IVAR_INTR:
77 1.1 jdolecek case PPBUS_IVAR_EPP_PROTO:
78 1.1 jdolecek case PPBUS_IVAR_DMA:
79 1.1 jdolecek return (bus->ppbus_read_ivar(dev->dv_parent, index, val));
80 1.1 jdolecek
81 1.1 jdolecek case PPBUS_IVAR_IEEE:
82 1.1 jdolecek *val = (bus->sc_use_ieee == PPBUS_ENABLE_IEEE) ? 1 : 0;
83 1.1 jdolecek break;
84 1.1 jdolecek
85 1.1 jdolecek default:
86 1.1 jdolecek return (ENOENT);
87 1.1 jdolecek }
88 1.1 jdolecek
89 1.1 jdolecek return 0;
90 1.1 jdolecek }
91 1.1 jdolecek
92 1.1 jdolecek /* Write an instance variable */
93 1.1 jdolecek int
94 1.1 jdolecek ppbus_write_ivar(struct device * dev, int index, unsigned int * val)
95 1.1 jdolecek {
96 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
97 1.1 jdolecek
98 1.1 jdolecek switch (index) {
99 1.1 jdolecek case PPBUS_IVAR_INTR:
100 1.1 jdolecek case PPBUS_IVAR_EPP_PROTO:
101 1.1 jdolecek case PPBUS_IVAR_DMA:
102 1.1 jdolecek return (bus->ppbus_write_ivar(dev->dv_parent, index, val));
103 1.1 jdolecek
104 1.1 jdolecek case PPBUS_IVAR_IEEE:
105 1.1 jdolecek bus->sc_use_ieee = ((*val != 0) ? PPBUS_ENABLE_IEEE :
106 1.1 jdolecek PPBUS_DISABLE_IEEE);
107 1.1 jdolecek break;
108 1.1 jdolecek
109 1.1 jdolecek default:
110 1.1 jdolecek return (ENOENT);
111 1.1 jdolecek }
112 1.1 jdolecek
113 1.1 jdolecek return 0;
114 1.1 jdolecek }
115 1.1 jdolecek
116 1.1 jdolecek /* Polls the bus for a max of 10-milliseconds */
117 1.1 jdolecek int
118 1.1 jdolecek ppbus_poll_bus(struct device * dev, int max, char mask, char status,
119 1.1 jdolecek int how)
120 1.1 jdolecek {
121 1.1 jdolecek int i, j, error;
122 1.1 jdolecek char r;
123 1.1 jdolecek
124 1.1 jdolecek /* try at least up to 10ms */
125 1.1 jdolecek for (j = 0; j < ((how & PPBUS_POLL) ? max : 1); j++) {
126 1.1 jdolecek for (i = 0; i < 10000; i++) {
127 1.1 jdolecek r = ppbus_rstr(dev);
128 1.1 jdolecek DELAY(1);
129 1.1 jdolecek if ((r & mask) == status)
130 1.1 jdolecek return (0);
131 1.1 jdolecek }
132 1.1 jdolecek }
133 1.1 jdolecek
134 1.1 jdolecek if (!(how & PPBUS_POLL)) {
135 1.1 jdolecek for (i = 0; max == PPBUS_FOREVER || i < max-1; i++) {
136 1.1 jdolecek if ((ppbus_rstr(dev) & mask) == status)
137 1.1 jdolecek return (0);
138 1.1 jdolecek
139 1.1 jdolecek switch (how) {
140 1.1 jdolecek case PPBUS_NOINTR:
141 1.1 jdolecek /* wait 10 ms */
142 1.1 jdolecek tsleep((caddr_t)dev, PPBUSPRI, "ppbuspoll", hz/100);
143 1.1 jdolecek break;
144 1.1 jdolecek
145 1.1 jdolecek case PPBUS_INTR:
146 1.1 jdolecek default:
147 1.1 jdolecek /* wait 10 ms */
148 1.1 jdolecek if (((error = tsleep((caddr_t)dev, PPBUSPRI | PCATCH,
149 1.1 jdolecek "ppbuspoll", hz/100)) != EWOULDBLOCK) != 0) {
150 1.1 jdolecek return (error);
151 1.1 jdolecek }
152 1.1 jdolecek break;
153 1.1 jdolecek }
154 1.1 jdolecek }
155 1.1 jdolecek }
156 1.1 jdolecek
157 1.1 jdolecek return (EWOULDBLOCK);
158 1.1 jdolecek }
159 1.1 jdolecek
160 1.1 jdolecek /* Get operating mode of the chipset */
161 1.1 jdolecek int
162 1.1 jdolecek ppbus_get_mode(struct device * dev)
163 1.1 jdolecek {
164 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
165 1.1 jdolecek
166 1.1 jdolecek return (bus->sc_mode);
167 1.1 jdolecek }
168 1.1 jdolecek
169 1.1 jdolecek /* Set the operating mode of the chipset, return 0 on success. */
170 1.1 jdolecek int
171 1.1 jdolecek ppbus_set_mode(struct device * dev, int mode, int options)
172 1.1 jdolecek {
173 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
174 1.1 jdolecek int error = 0;
175 1.1 jdolecek
176 1.1 jdolecek /* If no mode change, do nothing */
177 1.1 jdolecek if(bus->sc_mode == mode)
178 1.1 jdolecek return error;
179 1.1 jdolecek
180 1.1 jdolecek /* Do necessary negociations */
181 1.1 jdolecek if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
182 1.1 jdolecek /* Cannot negociate standard mode */
183 1.1 jdolecek if(!(mode & (PPBUS_FAST | PPBUS_COMPATIBLE))) {
184 1.1 jdolecek error = ppbus_1284_negociate(dev, mode, options);
185 1.1 jdolecek }
186 1.1 jdolecek /* Termination is unnecessary for standard<->fast */
187 1.1 jdolecek else if(!(bus->sc_mode & (PPBUS_FAST | PPBUS_COMPATIBLE))) {
188 1.1 jdolecek ppbus_1284_terminate(dev);
189 1.1 jdolecek }
190 1.1 jdolecek }
191 1.1 jdolecek
192 1.1 jdolecek if(!error) {
193 1.1 jdolecek /* Set mode and update mode of ppbus to actual mode */
194 1.1 jdolecek error = bus->ppbus_setmode(dev->dv_parent, mode);
195 1.1 jdolecek bus->sc_mode = bus->ppbus_getmode(dev->dv_parent);
196 1.1 jdolecek }
197 1.1 jdolecek
198 1.1 jdolecek /* Update host state if necessary */
199 1.1 jdolecek if(!(error) && (bus->sc_use_ieee == PPBUS_ENABLE_IEEE)) {
200 1.1 jdolecek switch(mode) {
201 1.1 jdolecek case PPBUS_COMPATIBLE:
202 1.1 jdolecek case PPBUS_FAST:
203 1.1 jdolecek case PPBUS_EPP:
204 1.1 jdolecek case PPBUS_ECP:
205 1.1 jdolecek ppbus_1284_set_state(dev, PPBUS_FORWARD_IDLE);
206 1.1 jdolecek break;
207 1.1 jdolecek
208 1.1 jdolecek case PPBUS_NIBBLE:
209 1.1 jdolecek case PPBUS_PS2:
210 1.1 jdolecek ppbus_1284_set_state(dev, PPBUS_REVERSE_IDLE);
211 1.1 jdolecek break;
212 1.1 jdolecek }
213 1.1 jdolecek }
214 1.1 jdolecek
215 1.1 jdolecek return error;
216 1.1 jdolecek }
217 1.1 jdolecek
218 1.1 jdolecek /* Write charaters to the port */
219 1.1 jdolecek int
220 1.1 jdolecek ppbus_write(struct device * dev, char * buf, int len, int how, size_t * cnt)
221 1.1 jdolecek {
222 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
223 1.1 jdolecek
224 1.1 jdolecek if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
225 1.1 jdolecek if(bus->sc_1284_state != PPBUS_FORWARD_IDLE) {
226 1.1 jdolecek printf("%s(%s): bus not in forward idle mode.\n",
227 1.1 jdolecek __func__, dev->dv_xname);
228 1.1 jdolecek return ENODEV;
229 1.1 jdolecek }
230 1.1 jdolecek }
231 1.1 jdolecek
232 1.1 jdolecek return (bus->ppbus_write(bus->sc_dev.dv_parent, buf, len, how, cnt));
233 1.1 jdolecek }
234 1.1 jdolecek
235 1.1 jdolecek /* Read charaters from the port */
236 1.1 jdolecek int
237 1.1 jdolecek ppbus_read(struct device * dev, char * buf, int len, int how, size_t * cnt)
238 1.1 jdolecek {
239 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
240 1.1 jdolecek
241 1.1 jdolecek if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
242 1.1 jdolecek if(bus->sc_1284_state != PPBUS_REVERSE_IDLE) {
243 1.1 jdolecek printf("%s(%s): bus not in reverse idle mode.\n",
244 1.1 jdolecek __func__, dev->dv_xname);
245 1.1 jdolecek return ENODEV;
246 1.1 jdolecek }
247 1.1 jdolecek }
248 1.1 jdolecek
249 1.1 jdolecek return (bus->ppbus_read(dev->dv_parent, buf, len, how, cnt));
250 1.1 jdolecek }
251 1.1 jdolecek
252 1.1 jdolecek /* Reset the EPP timeout bit in the status register */
253 1.1 jdolecek int
254 1.1 jdolecek ppbus_reset_epp_timeout(struct device * dev)
255 1.1 jdolecek {
256 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
257 1.1 jdolecek
258 1.1 jdolecek if(bus->sc_capabilities & PPBUS_HAS_EPP) {
259 1.1 jdolecek bus->ppbus_reset_epp_timeout(dev->dv_parent);
260 1.1 jdolecek return 0;
261 1.1 jdolecek }
262 1.1 jdolecek else {
263 1.1 jdolecek return ENODEV;
264 1.1 jdolecek }
265 1.1 jdolecek }
266 1.1 jdolecek
267 1.1 jdolecek /* Wait for the ECP FIFO to be empty */
268 1.1 jdolecek int
269 1.1 jdolecek ppbus_ecp_sync(struct device * dev)
270 1.1 jdolecek {
271 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
272 1.1 jdolecek
273 1.1 jdolecek if(bus->sc_capabilities & PPBUS_HAS_ECP) {
274 1.1 jdolecek bus->ppbus_ecp_sync(dev->dv_parent);
275 1.1 jdolecek return 0;
276 1.1 jdolecek }
277 1.1 jdolecek else {
278 1.1 jdolecek return ENODEV;
279 1.1 jdolecek }
280 1.1 jdolecek }
281 1.1 jdolecek
282 1.1 jdolecek /* Allocate DMA for use with ppbus */
283 1.1 jdolecek int
284 1.1 jdolecek ppbus_dma_malloc(struct device * dev, caddr_t * buf, bus_addr_t * addr,
285 1.1 jdolecek bus_size_t size)
286 1.1 jdolecek {
287 1.1 jdolecek struct ppbus_softc * ppbus = (struct ppbus_softc *) dev;
288 1.1 jdolecek
289 1.1 jdolecek if(ppbus->sc_capabilities & PPBUS_HAS_DMA)
290 1.1 jdolecek return (ppbus->ppbus_dma_malloc(dev->dv_parent, buf, addr,
291 1.1 jdolecek size));
292 1.1 jdolecek else
293 1.1 jdolecek return ENODEV;
294 1.1 jdolecek }
295 1.1 jdolecek
296 1.1 jdolecek /* Free memory allocated with ppbus_dma_malloc() */
297 1.1 jdolecek int
298 1.1 jdolecek ppbus_dma_free(struct device * dev, caddr_t * buf, bus_addr_t * addr,
299 1.1 jdolecek bus_size_t size)
300 1.1 jdolecek {
301 1.1 jdolecek struct ppbus_softc * ppbus = (struct ppbus_softc *) dev;
302 1.1 jdolecek
303 1.1 jdolecek if(ppbus->sc_capabilities & PPBUS_HAS_DMA) {
304 1.1 jdolecek ppbus->ppbus_dma_free(dev->dv_parent, buf, addr, size);
305 1.1 jdolecek return 0;
306 1.1 jdolecek }
307 1.1 jdolecek else {
308 1.1 jdolecek return ENODEV;
309 1.1 jdolecek }
310 1.1 jdolecek }
311 1.1 jdolecek
312 1.1 jdolecek /* Install a handler to be called by hardware interrupt handler */
313 1.1 jdolecek int ppbus_add_handler(struct device * dev, void (*func)(void *), void * arg)
314 1.1 jdolecek {
315 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
316 1.1 jdolecek
317 1.1 jdolecek if(bus->sc_capabilities & PPBUS_HAS_INTR)
318 1.1 jdolecek return bus->ppbus_add_handler(dev->dv_parent, func, arg);
319 1.1 jdolecek else
320 1.1 jdolecek return ENODEV;
321 1.1 jdolecek }
322 1.1 jdolecek
323 1.1 jdolecek /* Remove a handler registered with ppbus_add_handler() */
324 1.1 jdolecek int ppbus_remove_handler(struct device * dev, void (*func)(void *))
325 1.1 jdolecek {
326 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
327 1.1 jdolecek
328 1.1 jdolecek if(bus->sc_capabilities & PPBUS_HAS_INTR)
329 1.1 jdolecek return bus->ppbus_remove_handler(dev->dv_parent, func);
330 1.1 jdolecek else
331 1.1 jdolecek return ENODEV;
332 1.1 jdolecek }
333 1.1 jdolecek
334 1.1 jdolecek /*
335 1.1 jdolecek * ppbus_get_status()
336 1.1 jdolecek *
337 1.1 jdolecek * Read the status register and update the status info
338 1.1 jdolecek */
339 1.1 jdolecek int
340 1.1 jdolecek ppbus_get_status(struct device * dev, struct ppbus_status * status)
341 1.1 jdolecek {
342 1.1 jdolecek register char r = status->status = ppbus_rstr(dev);
343 1.1 jdolecek
344 1.1 jdolecek status->timeout = r & TIMEOUT;
345 1.1 jdolecek status->error = !(r & nFAULT);
346 1.1 jdolecek status->select = r & SELECT;
347 1.1 jdolecek status->paper_end = r & PERROR;
348 1.1 jdolecek status->ack = !(r & nACK);
349 1.1 jdolecek status->busy = !(r & nBUSY);
350 1.1 jdolecek
351 1.1 jdolecek return (0);
352 1.1 jdolecek }
353 1.1 jdolecek
354 1.1 jdolecek /* Allocate the device to perform transfers */
355 1.1 jdolecek int
356 1.1 jdolecek ppbus_request_bus(struct device * dev, struct device * busdev, int how,
357 1.1 jdolecek unsigned int timeout)
358 1.1 jdolecek {
359 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
360 1.1 jdolecek unsigned int counter = timeout;
361 1.1 jdolecek int priority = PPBUSPRI;
362 1.1 jdolecek int error;
363 1.1 jdolecek
364 1.1 jdolecek if(how & PPBUS_INTR)
365 1.1 jdolecek priority |= PCATCH;
366 1.1 jdolecek
367 1.1 jdolecek /* Loop until lock acquired (if PPBUS_WAIT) or an error occurs */
368 1.1 jdolecek for(;;) {
369 1.1 jdolecek error = lockmgr(&(bus->sc_lock), LK_EXCLUSIVE | LK_RECURSEFAIL,
370 1.1 jdolecek NULL);
371 1.1 jdolecek if(!error)
372 1.1 jdolecek break;
373 1.1 jdolecek
374 1.1 jdolecek if(how & PPBUS_WAIT) {
375 1.1 jdolecek error = ltsleep(bus, priority, __func__, hz/2, NULL);
376 1.1 jdolecek counter -= (hz/2);
377 1.1 jdolecek if(!(error))
378 1.1 jdolecek continue;
379 1.1 jdolecek else if(error != EWOULDBLOCK)
380 1.1 jdolecek goto end;
381 1.1 jdolecek if(counter == 0) {
382 1.1 jdolecek error = ETIMEDOUT;
383 1.1 jdolecek goto end;
384 1.1 jdolecek }
385 1.1 jdolecek }
386 1.1 jdolecek else {
387 1.1 jdolecek goto end;
388 1.1 jdolecek }
389 1.1 jdolecek }
390 1.1 jdolecek
391 1.1 jdolecek /* Set bus owner or return error if bus is taken */
392 1.1 jdolecek if(bus->ppbus_owner == NULL) {
393 1.1 jdolecek bus->ppbus_owner = busdev;
394 1.1 jdolecek error = 0;
395 1.1 jdolecek }
396 1.1 jdolecek else {
397 1.1 jdolecek error = EBUSY;
398 1.1 jdolecek }
399 1.1 jdolecek
400 1.1 jdolecek /* Release lock */
401 1.1 jdolecek lockmgr(&(bus->sc_lock), LK_RELEASE, NULL);
402 1.1 jdolecek
403 1.1 jdolecek end:
404 1.1 jdolecek return error;
405 1.1 jdolecek }
406 1.1 jdolecek
407 1.1 jdolecek /* Release the device allocated with ppbus_request_bus() */
408 1.1 jdolecek int
409 1.1 jdolecek ppbus_release_bus(struct device * dev, struct device * busdev, int how,
410 1.1 jdolecek unsigned int timeout)
411 1.1 jdolecek {
412 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
413 1.1 jdolecek unsigned int counter = timeout;
414 1.1 jdolecek int priority = PPBUSPRI;
415 1.1 jdolecek int error;
416 1.1 jdolecek
417 1.1 jdolecek if(how & PPBUS_INTR)
418 1.1 jdolecek priority |= PCATCH;
419 1.1 jdolecek
420 1.1 jdolecek /* Loop until lock acquired (if PPBUS_WAIT) or an error occurs */
421 1.1 jdolecek for(;;) {
422 1.1 jdolecek error = lockmgr(&(bus->sc_lock), LK_EXCLUSIVE | LK_RECURSEFAIL,
423 1.1 jdolecek NULL);
424 1.1 jdolecek if(!error)
425 1.1 jdolecek break;
426 1.1 jdolecek
427 1.1 jdolecek if(how & PPBUS_WAIT) {
428 1.1 jdolecek error = ltsleep(bus, priority, __func__, hz/2, NULL);
429 1.1 jdolecek counter -= (hz/2);
430 1.1 jdolecek if(!(error))
431 1.1 jdolecek continue;
432 1.1 jdolecek else if(error != EWOULDBLOCK)
433 1.1 jdolecek goto end;
434 1.1 jdolecek if(counter == 0) {
435 1.1 jdolecek error = ETIMEDOUT;
436 1.1 jdolecek goto end;
437 1.1 jdolecek }
438 1.1 jdolecek }
439 1.1 jdolecek else {
440 1.1 jdolecek goto end;
441 1.1 jdolecek }
442 1.1 jdolecek }
443 1.1 jdolecek
444 1.1 jdolecek /* If the device is the owner, release bus */
445 1.1 jdolecek if(bus->ppbus_owner != busdev) {
446 1.1 jdolecek error = EINVAL;
447 1.1 jdolecek }
448 1.1 jdolecek else {
449 1.1 jdolecek bus->ppbus_owner = NULL;
450 1.1 jdolecek error = 0;
451 1.1 jdolecek }
452 1.1 jdolecek
453 1.1 jdolecek /* Release lock */
454 1.1 jdolecek lockmgr(&(bus->sc_lock), LK_RELEASE, NULL);
455 1.1 jdolecek
456 1.1 jdolecek end:
457 1.1 jdolecek return error;
458 1.1 jdolecek }
459 1.1 jdolecek
460 1.1 jdolecek
461 1.1 jdolecek /* IEEE 1284-based probes */
462 1.1 jdolecek
463 1.1 jdolecek #ifndef DONTPROBE_1284
464 1.1 jdolecek
465 1.1 jdolecek static char *pnp_tokens[] = {
466 1.1 jdolecek "PRINTER", "MODEM", "NET", "HDC", "PCMCIA", "MEDIA",
467 1.1 jdolecek "FDC", "PORTS", "SCANNER", "DIGICAM", "", NULL };
468 1.1 jdolecek
469 1.1 jdolecek /* ??? */
470 1.1 jdolecek #if 0
471 1.1 jdolecek static char *pnp_classes[] = {
472 1.1 jdolecek "printer", "modem", "network device",
473 1.1 jdolecek "hard disk", "PCMCIA", "multimedia device",
474 1.1 jdolecek "floppy disk", "ports", "scanner",
475 1.1 jdolecek "digital camera", "unknown device", NULL };
476 1.1 jdolecek #endif
477 1.1 jdolecek
478 1.1 jdolecek /*
479 1.1 jdolecek * Search the first occurence of a token within a string
480 1.1 jdolecek * XXX should use strxxx() calls
481 1.1 jdolecek */
482 1.1 jdolecek static char *
483 1.1 jdolecek search_token(char *str, int slen, char *token)
484 1.1 jdolecek {
485 1.1 jdolecek char *p;
486 1.1 jdolecek int tlen, i, j;
487 1.1 jdolecek
488 1.1 jdolecek #define UNKNOWN_LENGTH -1
489 1.1 jdolecek
490 1.1 jdolecek if (slen == UNKNOWN_LENGTH)
491 1.1 jdolecek /* get string's length */
492 1.1 jdolecek for (slen = 0, p = str; *p != '\0'; p++)
493 1.1 jdolecek slen ++;
494 1.1 jdolecek
495 1.1 jdolecek /* get token's length */
496 1.1 jdolecek for (tlen = 0, p = token; *p != '\0'; p++)
497 1.1 jdolecek tlen ++;
498 1.1 jdolecek
499 1.1 jdolecek if (tlen == 0)
500 1.1 jdolecek return (str);
501 1.1 jdolecek
502 1.1 jdolecek for (i = 0; i <= slen-tlen; i++) {
503 1.1 jdolecek for (j = 0; j < tlen; j++)
504 1.1 jdolecek if (str[i+j] != token[j])
505 1.1 jdolecek break;
506 1.1 jdolecek if (j == tlen)
507 1.1 jdolecek return (&str[i]);
508 1.1 jdolecek }
509 1.1 jdolecek
510 1.1 jdolecek return (NULL);
511 1.1 jdolecek }
512 1.1 jdolecek
513 1.1 jdolecek /* Stores the class ID of the peripherial in soft config data */
514 1.1 jdolecek void
515 1.1 jdolecek ppbus_pnp_detect(struct device * dev)
516 1.1 jdolecek {
517 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
518 1.1 jdolecek int i;
519 1.1 jdolecek int error;
520 1.1 jdolecek size_t len = 0;
521 1.1 jdolecek size_t str_sz = 0;
522 1.1 jdolecek char * str = NULL;
523 1.1 jdolecek char * class = NULL;
524 1.1 jdolecek char * token;
525 1.1 jdolecek
526 1.1 jdolecek #ifdef PPBUS_VERBOSE
527 1.1 jdolecek printf("%s: Probing for PnP devices.\n", dev->dv_xname);
528 1.1 jdolecek #endif
529 1.1 jdolecek
530 1.1 jdolecek error = ppbus_1284_read_id(dev, PPBUS_NIBBLE, &str, &str_sz, &len);
531 1.1 jdolecek if(str_sz != len) {
532 1.1 jdolecek #ifdef DEBUG_1284
533 1.1 jdolecek printf("%s(%s): device returned less characters than expected "
534 1.1 jdolecek "in device ID.\n", __func__, dev->dv_xname);
535 1.1 jdolecek #endif
536 1.1 jdolecek }
537 1.1 jdolecek if(error) {
538 1.1 jdolecek printf("%s: Error getting device ID (errno = %d)\n",
539 1.1 jdolecek dev->dv_xname, error);
540 1.1 jdolecek goto end_detect;
541 1.1 jdolecek }
542 1.1 jdolecek
543 1.1 jdolecek #ifdef DEBUG_1284
544 1.1 jdolecek printf("%s: <PnP> %d characters: ", dev->dv_xname, len);
545 1.1 jdolecek for (i = 0; i < len; i++)
546 1.1 jdolecek printf("%c(0x%x) ", str[i], str[i]);
547 1.1 jdolecek printf("\n");
548 1.1 jdolecek #endif
549 1.1 jdolecek
550 1.1 jdolecek /* replace ';' characters by '\0' */
551 1.1 jdolecek for (i = 0; i < len; i++)
552 1.1 jdolecek if(str[i] == ';') str[i] = '\0';
553 1.1 jdolecek /* str[i] = (str[i] == ';') ? '\0' : str[i]; */
554 1.1 jdolecek
555 1.1 jdolecek if ((token = search_token(str, len, "MFG")) != NULL ||
556 1.1 jdolecek (token = search_token(str, len, "MANUFACTURER")) != NULL)
557 1.1 jdolecek printf("%s: <%s", dev->dv_xname,
558 1.1 jdolecek search_token(token, UNKNOWN_LENGTH, ":") + 1);
559 1.1 jdolecek else
560 1.1 jdolecek printf("%s: <unknown", dev->dv_xname);
561 1.1 jdolecek
562 1.1 jdolecek if ((token = search_token(str, len, "MDL")) != NULL ||
563 1.1 jdolecek (token = search_token(str, len, "MODEL")) != NULL)
564 1.1 jdolecek printf(" %s",
565 1.1 jdolecek search_token(token, UNKNOWN_LENGTH, ":") + 1);
566 1.1 jdolecek
567 1.1 jdolecek if ((token = search_token(str, len, "REV")) != NULL)
568 1.1 jdolecek printf(".%s",
569 1.1 jdolecek search_token(token, UNKNOWN_LENGTH, ":") + 1);
570 1.1 jdolecek
571 1.1 jdolecek printf(">");
572 1.1 jdolecek
573 1.1 jdolecek if ((token = search_token(str, len, "CLS")) != NULL) {
574 1.1 jdolecek class = search_token(token, UNKNOWN_LENGTH, ":") + 1;
575 1.1 jdolecek printf(" %s", class);
576 1.1 jdolecek }
577 1.1 jdolecek
578 1.1 jdolecek if ((token = search_token(str, len, "CMD")) != NULL ||
579 1.1 jdolecek (token = search_token(str, len, "COMMAND")) != NULL)
580 1.1 jdolecek printf(" %s",
581 1.1 jdolecek search_token(token, UNKNOWN_LENGTH, ":") + 1);
582 1.1 jdolecek
583 1.1 jdolecek printf("\n");
584 1.1 jdolecek
585 1.1 jdolecek if (class) {
586 1.1 jdolecek /* identify class ident */
587 1.1 jdolecek for (i = 0; pnp_tokens[i] != NULL; i++) {
588 1.1 jdolecek if (search_token(class, len, pnp_tokens[i]) != NULL) {
589 1.1 jdolecek bus->sc_class_id = i;
590 1.1 jdolecek goto end_detect;
591 1.1 jdolecek }
592 1.1 jdolecek }
593 1.1 jdolecek }
594 1.1 jdolecek bus->sc_class_id = PPBUS_PNP_UNKNOWN;
595 1.1 jdolecek
596 1.1 jdolecek end_detect:
597 1.1 jdolecek if(str)
598 1.1 jdolecek free(str, M_DEVBUF);
599 1.1 jdolecek return;
600 1.1 jdolecek }
601 1.1 jdolecek
602 1.1 jdolecek /* Scan the ppbus for IEEE1284 compliant devices */
603 1.1 jdolecek int
604 1.1 jdolecek ppbus_scan_bus(struct device * dev)
605 1.1 jdolecek {
606 1.1 jdolecek struct ppbus_softc * bus = (struct ppbus_softc *) dev;
607 1.1 jdolecek int error;
608 1.1 jdolecek
609 1.1 jdolecek /* Try IEEE1284 modes, one device only (no IEEE1284.3 support) */
610 1.1 jdolecek
611 1.1 jdolecek error = ppbus_1284_negociate(dev, PPBUS_NIBBLE, 0);
612 1.1 jdolecek if(!(error))
613 1.1 jdolecek printf("/NIBBLE");
614 1.1 jdolecek else if((bus->sc_1284_state == PPBUS_ERROR) && (bus->sc_1284_error ==
615 1.1 jdolecek PPBUS_NOT_IEEE1284))
616 1.1 jdolecek goto end_scan;
617 1.1 jdolecek ppbus_1284_terminate(dev);
618 1.1 jdolecek
619 1.1 jdolecek error = ppbus_1284_negociate(dev, PPBUS_PS2, 0);
620 1.1 jdolecek if(!(error))
621 1.1 jdolecek printf("/PS2");
622 1.1 jdolecek ppbus_1284_terminate(dev);
623 1.1 jdolecek
624 1.1 jdolecek error = ppbus_1284_negociate(dev, PPBUS_ECP, 0);
625 1.1 jdolecek if(!(error))
626 1.1 jdolecek printf("/ECP");
627 1.1 jdolecek ppbus_1284_terminate(dev);
628 1.1 jdolecek
629 1.1 jdolecek error = ppbus_1284_negociate(dev, PPBUS_ECP, PPBUS_USE_RLE);
630 1.1 jdolecek if(!(error))
631 1.1 jdolecek printf("/ECP_RLE");
632 1.1 jdolecek ppbus_1284_terminate(dev);
633 1.1 jdolecek
634 1.1 jdolecek error = ppbus_1284_negociate(dev, PPBUS_EPP, 0);
635 1.1 jdolecek if(!(error))
636 1.1 jdolecek printf("/EPP");
637 1.1 jdolecek ppbus_1284_terminate(dev);
638 1.1 jdolecek
639 1.1 jdolecek printf("\n");
640 1.1 jdolecek
641 1.1 jdolecek return 0;
642 1.1 jdolecek
643 1.1 jdolecek end_scan:
644 1.1 jdolecek return error;
645 1.1 jdolecek }
646 1.1 jdolecek
647 1.1 jdolecek #endif /* !DONTPROBE_1284 */
648 1.1 jdolecek
649