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