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