maple.c revision 1.6 1 1.6 marcus /* $NetBSD: maple.c,v 1.6 2001/03/16 19:57:49 marcus Exp $ */
2 1.1 marcus
3 1.3 marcus /*-
4 1.1 marcus * Copyright (c) 2001 Marcus Comstedt
5 1.1 marcus * All rights reserved.
6 1.1 marcus *
7 1.1 marcus * Redistribution and use in source and binary forms, with or without
8 1.1 marcus * modification, are permitted provided that the following conditions
9 1.1 marcus * are met:
10 1.1 marcus * 1. Redistributions of source code must retain the above copyright
11 1.1 marcus * notice, this list of conditions and the following disclaimer.
12 1.1 marcus * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 marcus * notice, this list of conditions and the following disclaimer in the
14 1.1 marcus * documentation and/or other materials provided with the distribution.
15 1.1 marcus * 3. All advertising materials mentioning features or use of this software
16 1.1 marcus * must display the following acknowledgement:
17 1.3 marcus * This product includes software developed by Marcus Comstedt.
18 1.3 marcus * 4. Neither the name of The NetBSD Foundation nor the names of its
19 1.3 marcus * contributors may be used to endorse or promote products derived
20 1.3 marcus * from this software without specific prior written permission.
21 1.1 marcus *
22 1.3 marcus * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
23 1.3 marcus * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
24 1.3 marcus * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
25 1.3 marcus * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
26 1.3 marcus * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 1.3 marcus * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 1.3 marcus * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 1.3 marcus * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 1.3 marcus * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 1.3 marcus * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 1.3 marcus * POSSIBILITY OF SUCH DAMAGE.
33 1.1 marcus */
34 1.1 marcus
35 1.1 marcus #include <sys/param.h>
36 1.1 marcus #include <sys/device.h>
37 1.1 marcus #include <sys/fcntl.h>
38 1.1 marcus #include <sys/poll.h>
39 1.1 marcus #include <sys/select.h>
40 1.1 marcus #include <sys/proc.h>
41 1.1 marcus #include <sys/signalvar.h>
42 1.1 marcus #include <sys/systm.h>
43 1.1 marcus
44 1.1 marcus #include <uvm/uvm_extern.h>
45 1.1 marcus
46 1.1 marcus #include <machine/cpu.h>
47 1.1 marcus #include <machine/bus.h>
48 1.1 marcus #include <sh3/shbvar.h>
49 1.1 marcus #include <sh3/pmap.h>
50 1.1 marcus
51 1.1 marcus
52 1.1 marcus #include <dreamcast/dev/maple/maple.h>
53 1.1 marcus #include <dreamcast/dev/maple/mapleconf.h>
54 1.1 marcus #include <dreamcast/dev/maple/maplevar.h>
55 1.1 marcus #include <dreamcast/dev/maple/maplereg.h>
56 1.1 marcus
57 1.1 marcus
58 1.5 marcus #define MAPLE_CALLOUT_TICKS 2
59 1.1 marcus
60 1.1 marcus /*
61 1.1 marcus * Function declarations.
62 1.1 marcus */
63 1.1 marcus static int maplematch __P((struct device *, struct cfdata *, void *));
64 1.1 marcus static void mapleattach __P((struct device *, struct device *, void *));
65 1.1 marcus static int mapleprint __P((void *, const char *));
66 1.4 thorpej static int maplesubmatch __P((struct device *, struct cfdata *, void *));
67 1.1 marcus static void maple_attach_dev __P((struct maple_softc *, int, int));
68 1.1 marcus static void maple_begin_txbuf __P((struct maple_softc *));
69 1.1 marcus static int maple_end_txbuf __P((struct maple_softc *));
70 1.1 marcus static void maple_write_command __P((struct maple_softc *, int, int,
71 1.1 marcus int, int, void *));
72 1.1 marcus static void maple_scanbus __P((struct maple_softc *));
73 1.1 marcus static void maple_callout __P((void *));
74 1.1 marcus static void maple_send_commands __P((struct maple_softc *));
75 1.1 marcus static void maple_check_responses __P((struct maple_softc *));
76 1.1 marcus
77 1.2 marcus int maple_alloc_dma __P((size_t, vaddr_t *, paddr_t *));
78 1.2 marcus void maple_free_dma __P((paddr_t, size_t));
79 1.2 marcus
80 1.1 marcus
81 1.1 marcus /*
82 1.1 marcus * Global variables.
83 1.1 marcus */
84 1.1 marcus int maple_polling = 0; /* Are we polling? (Debugger mode) */
85 1.1 marcus
86 1.1 marcus /*
87 1.1 marcus * Driver definition.
88 1.1 marcus */
89 1.1 marcus struct cfattach maple_ca = {
90 1.1 marcus sizeof(struct maple_softc), maplematch, mapleattach
91 1.1 marcus };
92 1.1 marcus
93 1.1 marcus static int
94 1.1 marcus maplematch(parent, cf, aux)
95 1.1 marcus struct device *parent;
96 1.1 marcus struct cfdata *cf;
97 1.1 marcus void *aux;
98 1.1 marcus {
99 1.1 marcus struct shb_attach_args *sa = aux;
100 1.1 marcus
101 1.1 marcus if (strcmp("maple", cf->cf_driver->cd_name))
102 1.1 marcus return (0);
103 1.1 marcus
104 1.1 marcus sa->ia_iosize = 0 /* 0x100 */;
105 1.1 marcus return (1);
106 1.1 marcus }
107 1.1 marcus
108 1.1 marcus static void
109 1.1 marcus maple_attach_dev(sc, port, subunit)
110 1.1 marcus struct maple_softc *sc;
111 1.1 marcus int port;
112 1.1 marcus int subunit;
113 1.1 marcus {
114 1.1 marcus struct maple_attach_args ma;
115 1.4 thorpej
116 1.1 marcus ma.ma_port = port;
117 1.1 marcus ma.ma_subunit = subunit;
118 1.1 marcus ma.ma_devinfo = &sc->sc_unit[port][subunit].devinfo;
119 1.4 thorpej
120 1.4 thorpej (void) config_found_sm(&sc->sc_dev, &ma, mapleprint, maplesubmatch);
121 1.1 marcus }
122 1.1 marcus
123 1.1 marcus static void
124 1.1 marcus maple_begin_txbuf(sc)
125 1.1 marcus struct maple_softc *sc;
126 1.1 marcus {
127 1.1 marcus sc->sc_txlink = sc->sc_txpos = sc->sc_txbuf;
128 1.1 marcus }
129 1.1 marcus
130 1.1 marcus static int
131 1.1 marcus maple_end_txbuf(sc)
132 1.1 marcus struct maple_softc *sc;
133 1.1 marcus {
134 1.1 marcus /* if no frame have been written, we can't mark the
135 1.1 marcus list end, and so the DMA must not be activated */
136 1.1 marcus if (sc->sc_txpos == sc->sc_txbuf)
137 1.1 marcus return (0);
138 1.1 marcus
139 1.1 marcus *sc->sc_txlink |= 0x80000000;
140 1.1 marcus
141 1.1 marcus return (1);
142 1.1 marcus }
143 1.1 marcus
144 1.1 marcus static int8_t subunit_code[] = { 0x20, 0x01, 0x02, 0x04, 0x08, 0x10 };
145 1.1 marcus
146 1.1 marcus static void
147 1.1 marcus maple_write_command(sc, port, subunit, command, datalen, dataaddr)
148 1.1 marcus struct maple_softc *sc;
149 1.1 marcus int port;
150 1.1 marcus int subunit;
151 1.1 marcus int command;
152 1.1 marcus int datalen;
153 1.1 marcus void *dataaddr;
154 1.1 marcus {
155 1.1 marcus int to, from;
156 1.1 marcus u_int32_t *p = sc->sc_txpos;
157 1.1 marcus
158 1.1 marcus if ((port & ~(MAPLE_PORTS-1)) != 0 ||
159 1.1 marcus subunit < 0 || subunit >= MAPLE_SUBUNITS)
160 1.1 marcus return;
161 1.1 marcus
162 1.1 marcus /* Compute sender and recipient address */
163 1.1 marcus from = port << 6;
164 1.1 marcus to = from | subunit_code[subunit];
165 1.1 marcus
166 1.1 marcus /* Max data length = 255 longs = 1020 bytes */
167 1.1 marcus if(datalen > 255)
168 1.1 marcus datalen = 255;
169 1.1 marcus else if(datalen < 0)
170 1.1 marcus datalen = 0;
171 1.1 marcus
172 1.1 marcus sc->sc_txlink = p;
173 1.1 marcus
174 1.1 marcus /* Set length of packet and destination port (A-D) */
175 1.1 marcus *p++ = datalen | (port << 16);
176 1.1 marcus
177 1.1 marcus /* Write address to receive buffer where the response
178 1.1 marcus frame should be put */
179 1.1 marcus *p++ = sc->sc_rxbuf_phys[port][subunit];
180 1.1 marcus
181 1.1 marcus /* Create the frame header. The fields are assembled "backwards"
182 1.1 marcus because of the Maple Bus big-endianness. */
183 1.1 marcus *p++ = (command & 0xff) | (to << 8) | (from << 16) | (datalen << 24);
184 1.1 marcus
185 1.1 marcus /* Copy parameter data, if any */
186 1.1 marcus if (datalen > 0) {
187 1.1 marcus u_int32_t *param = dataaddr;
188 1.1 marcus int i;
189 1.1 marcus for (i = 0; i < datalen; i++)
190 1.1 marcus *p++ = *param++;
191 1.1 marcus }
192 1.1 marcus
193 1.1 marcus sc->sc_txpos = p;
194 1.1 marcus }
195 1.1 marcus
196 1.1 marcus static void
197 1.1 marcus maple_scanbus(sc)
198 1.1 marcus struct maple_softc *sc;
199 1.1 marcus {
200 1.5 marcus int p, s;
201 1.1 marcus
202 1.1 marcus maple_polling = 1;
203 1.1 marcus
204 1.1 marcus maple_begin_txbuf(sc);
205 1.1 marcus
206 1.1 marcus for (p = 0; p < MAPLE_PORTS; p++) {
207 1.1 marcus maple_write_command(sc, p, 0, MAPLE_COMMAND_DEVINFO, 0, NULL);
208 1.1 marcus }
209 1.1 marcus
210 1.1 marcus if (maple_end_txbuf(sc)) {
211 1.1 marcus
212 1.1 marcus MAPLE_DMAADDR = sc->sc_txbuf_phys;
213 1.1 marcus MAPLE_STATE = 1;
214 1.1 marcus while (MAPLE_STATE != 0)
215 1.1 marcus ;
216 1.1 marcus
217 1.1 marcus for (p = 0; p < MAPLE_PORTS; p++)
218 1.5 marcus if ((sc->sc_rxbuf[p][0][0] & 0xff) == MAPLE_RESPONSE_DEVINFO)
219 1.1 marcus
220 1.6 marcus sc->sc_port_units[p] = ((sc->sc_rxbuf[p][0][0]>>15)&0x3e)|1;
221 1.1 marcus
222 1.5 marcus else
223 1.1 marcus
224 1.5 marcus sc->sc_port_units[p] = 0;
225 1.1 marcus
226 1.5 marcus
227 1.5 marcus maple_begin_txbuf(sc);
228 1.5 marcus
229 1.5 marcus for (p = 0; p < MAPLE_PORTS; p++) {
230 1.5 marcus for (s = 0; s < MAPLE_SUBUNITS; s++) {
231 1.5 marcus if (sc->sc_port_units[p] & (1<<s))
232 1.5 marcus maple_write_command(sc, p, s, MAPLE_COMMAND_DEVINFO, 0, NULL);
233 1.1 marcus }
234 1.5 marcus }
235 1.5 marcus
236 1.5 marcus if (maple_end_txbuf(sc)) {
237 1.5 marcus
238 1.5 marcus MAPLE_DMAADDR = sc->sc_txbuf_phys;
239 1.5 marcus MAPLE_STATE = 1;
240 1.5 marcus while (MAPLE_STATE != 0)
241 1.5 marcus ;
242 1.5 marcus
243 1.5 marcus for (p = 0; p < MAPLE_PORTS; p++)
244 1.5 marcus for (s = 0; s < MAPLE_SUBUNITS; s++)
245 1.5 marcus if (sc->sc_port_units[p] & (1<<s)) {
246 1.5 marcus
247 1.5 marcus if ((sc->sc_rxbuf[p][s][0] & 0xff) ==
248 1.5 marcus MAPLE_RESPONSE_DEVINFO) {
249 1.5 marcus
250 1.5 marcus u_int32_t *to_swap;
251 1.5 marcus int i;
252 1.5 marcus
253 1.5 marcus bcopy(sc->sc_rxbuf[p][s]+1,
254 1.5 marcus (to_swap = &sc->sc_unit[p][s].devinfo.di_func),
255 1.5 marcus sizeof(struct maple_devinfo));
256 1.5 marcus
257 1.5 marcus for (i = 0; i < 4; i++, to_swap++)
258 1.5 marcus *to_swap = ntohl(*to_swap);
259 1.5 marcus
260 1.5 marcus maple_attach_dev(sc, p, s);
261 1.5 marcus
262 1.5 marcus } else {
263 1.5 marcus
264 1.5 marcus printf("%s: no response from port %d subunit %d\n",
265 1.5 marcus sc->sc_dev.dv_xname, p, s);
266 1.5 marcus }
267 1.5 marcus }
268 1.5 marcus
269 1.5 marcus }
270 1.1 marcus
271 1.1 marcus }
272 1.1 marcus
273 1.1 marcus maple_polling = 0;
274 1.1 marcus
275 1.1 marcus }
276 1.1 marcus
277 1.1 marcus static void
278 1.1 marcus maple_send_commands(sc)
279 1.1 marcus struct maple_softc *sc;
280 1.1 marcus {
281 1.5 marcus int p, s;
282 1.1 marcus
283 1.1 marcus if (sc->maple_commands_pending || MAPLE_STATE != 0)
284 1.1 marcus return;
285 1.1 marcus
286 1.1 marcus maple_begin_txbuf(sc);
287 1.1 marcus
288 1.1 marcus for (p = 0; p < MAPLE_PORTS; p++) {
289 1.1 marcus
290 1.5 marcus for (s = 0; s < MAPLE_SUBUNITS; s++) {
291 1.5 marcus
292 1.5 marcus if (sc->sc_unit[p][s].getcond_callback != NULL) {
293 1.1 marcus
294 1.5 marcus u_int32_t func = ntohl(sc->sc_unit[p][s].getcond_func);
295 1.5 marcus
296 1.5 marcus maple_write_command(sc, p, s, MAPLE_COMMAND_GETCOND, 1, &func);
297 1.1 marcus
298 1.5 marcus }
299 1.1 marcus
300 1.1 marcus }
301 1.1 marcus
302 1.1 marcus }
303 1.1 marcus
304 1.1 marcus if (!maple_end_txbuf(sc))
305 1.1 marcus return;
306 1.1 marcus
307 1.1 marcus MAPLE_DMAADDR = sc->sc_txbuf_phys;
308 1.1 marcus MAPLE_STATE = 1;
309 1.1 marcus
310 1.1 marcus sc->maple_commands_pending = 1;
311 1.1 marcus }
312 1.1 marcus
313 1.1 marcus static void
314 1.1 marcus maple_check_responses(sc)
315 1.1 marcus struct maple_softc *sc;
316 1.1 marcus {
317 1.5 marcus int p, s;
318 1.1 marcus
319 1.1 marcus if (!sc->maple_commands_pending || MAPLE_STATE != 0)
320 1.1 marcus return;
321 1.1 marcus
322 1.1 marcus for (p = 0; p < MAPLE_PORTS; p++) {
323 1.5 marcus for (s = 0; s < MAPLE_SUBUNITS; s++) {
324 1.5 marcus struct maple_unit * u = &sc->sc_unit[p][s];
325 1.5 marcus if (u->getcond_callback != NULL &&
326 1.5 marcus (sc->sc_rxbuf[p][s][0] & 0xff) == MAPLE_RESPONSE_DATATRF &&
327 1.5 marcus (sc->sc_rxbuf[p][s][0]>>24) >= 1 &&
328 1.5 marcus htonl(sc->sc_rxbuf[p][s][1]) == u->getcond_func) {
329 1.5 marcus (*u->getcond_callback)(u->getcond_data,
330 1.5 marcus (void *)(sc->sc_rxbuf[p][s]+2),
331 1.5 marcus ((sc->sc_rxbuf[p][s][0]>>22)&1020)-4);
332 1.5 marcus }
333 1.1 marcus }
334 1.1 marcus }
335 1.1 marcus
336 1.1 marcus sc->maple_commands_pending = 0;
337 1.1 marcus }
338 1.1 marcus
339 1.1 marcus void
340 1.1 marcus maple_run_polling(dev)
341 1.1 marcus struct device *dev;
342 1.1 marcus {
343 1.1 marcus struct maple_softc *sc;
344 1.1 marcus
345 1.1 marcus sc = (struct maple_softc *)dev;
346 1.1 marcus
347 1.1 marcus if (MAPLE_STATE != 0)
348 1.1 marcus return;
349 1.1 marcus
350 1.1 marcus maple_send_commands(sc);
351 1.1 marcus
352 1.1 marcus while (MAPLE_STATE != 0)
353 1.1 marcus ;
354 1.1 marcus
355 1.1 marcus maple_check_responses(sc);
356 1.1 marcus }
357 1.1 marcus
358 1.1 marcus void
359 1.1 marcus maple_set_condition_callback(dev, port, subunit, func, callback, data)
360 1.1 marcus struct device *dev;
361 1.1 marcus int port;
362 1.1 marcus int subunit;
363 1.1 marcus u_int32_t func;
364 1.1 marcus void (*callback)(void *, void *, int);
365 1.1 marcus void *data;
366 1.1 marcus {
367 1.1 marcus struct maple_softc *sc;
368 1.1 marcus
369 1.1 marcus sc = (struct maple_softc *)dev;
370 1.1 marcus
371 1.1 marcus if ((port & ~(MAPLE_PORTS-1)) != 0 ||
372 1.1 marcus subunit < 0 || subunit >= MAPLE_SUBUNITS)
373 1.1 marcus return;
374 1.1 marcus
375 1.1 marcus sc->sc_unit[port][subunit].getcond_func = func;
376 1.1 marcus sc->sc_unit[port][subunit].getcond_callback = callback;
377 1.1 marcus sc->sc_unit[port][subunit].getcond_data = data;
378 1.1 marcus }
379 1.1 marcus
380 1.1 marcus static void
381 1.1 marcus maple_callout(ctx)
382 1.1 marcus void *ctx;
383 1.1 marcus {
384 1.1 marcus struct maple_softc *sc = ctx;
385 1.1 marcus
386 1.1 marcus if(!maple_polling) {
387 1.1 marcus
388 1.1 marcus maple_check_responses(sc);
389 1.1 marcus
390 1.1 marcus maple_send_commands(sc);
391 1.1 marcus
392 1.1 marcus }
393 1.1 marcus
394 1.1 marcus callout_reset(&sc->maple_callout_ch, MAPLE_CALLOUT_TICKS,
395 1.1 marcus (void *)maple_callout, sc);
396 1.1 marcus }
397 1.1 marcus
398 1.2 marcus int
399 1.2 marcus maple_alloc_dma(size, vap, pap)
400 1.2 marcus size_t size;
401 1.2 marcus vaddr_t *vap;
402 1.2 marcus paddr_t *pap;
403 1.2 marcus {
404 1.2 marcus extern paddr_t avail_start, avail_end; /* from pmap.c */
405 1.2 marcus
406 1.2 marcus struct pglist mlist;
407 1.2 marcus vm_page_t m;
408 1.2 marcus int error;
409 1.2 marcus
410 1.2 marcus size = round_page(size);
411 1.2 marcus
412 1.2 marcus TAILQ_INIT(&mlist);
413 1.2 marcus error = uvm_pglistalloc(size, avail_start, avail_end - PAGE_SIZE,
414 1.2 marcus 0, 0, &mlist, 1, 0);
415 1.2 marcus if (error)
416 1.2 marcus return (error);
417 1.2 marcus
418 1.2 marcus m = TAILQ_FIRST(&mlist);
419 1.2 marcus *pap = VM_PAGE_TO_PHYS(m);
420 1.2 marcus *vap = SH3_PHYS_TO_P2SEG(VM_PAGE_TO_PHYS(m));
421 1.2 marcus
422 1.2 marcus return (0);
423 1.2 marcus }
424 1.2 marcus
425 1.2 marcus void
426 1.2 marcus maple_free_dma(paddr, size)
427 1.2 marcus paddr_t paddr;
428 1.2 marcus size_t size;
429 1.2 marcus {
430 1.2 marcus struct pglist mlist;
431 1.2 marcus vm_page_t m;
432 1.2 marcus bus_addr_t addr;
433 1.2 marcus
434 1.2 marcus TAILQ_INIT(&mlist);
435 1.2 marcus for (addr = paddr; addr < paddr + size; addr += PAGE_SIZE) {
436 1.2 marcus m = PHYS_TO_VM_PAGE(addr);
437 1.2 marcus TAILQ_INSERT_TAIL(&mlist, m, pageq);
438 1.2 marcus }
439 1.2 marcus uvm_pglistfree(&mlist);
440 1.2 marcus }
441 1.2 marcus
442 1.1 marcus static void
443 1.1 marcus mapleattach(parent, self, aux)
444 1.1 marcus struct device *parent, *self;
445 1.1 marcus void *aux;
446 1.1 marcus {
447 1.1 marcus struct maple_softc *sc;
448 1.1 marcus vaddr_t dmabuffer;
449 1.2 marcus paddr_t dmabuffer_phys;
450 1.1 marcus u_int32_t *p;
451 1.1 marcus int i, j;
452 1.1 marcus
453 1.1 marcus sc = (struct maple_softc *)self;
454 1.1 marcus
455 1.1 marcus printf("\n");
456 1.1 marcus
457 1.2 marcus if (maple_alloc_dma(MAPLE_DMABUF_SIZE, &dmabuffer, &dmabuffer_phys)) {
458 1.2 marcus printf("%s: unable to allocate DMA buffers.\n", sc->sc_dev.dv_xname);
459 1.2 marcus return;
460 1.2 marcus }
461 1.1 marcus
462 1.2 marcus p = (u_int32_t *) dmabuffer;
463 1.1 marcus
464 1.1 marcus for (i = 0; i < MAPLE_PORTS; i++)
465 1.1 marcus for (j = 0; j < MAPLE_SUBUNITS; j++) {
466 1.1 marcus
467 1.1 marcus sc->sc_rxbuf[i][j] = p;
468 1.1 marcus sc->sc_rxbuf_phys[i][j] = SH3_P2SEG_TO_PHYS(p);
469 1.1 marcus p += 256;
470 1.1 marcus
471 1.1 marcus }
472 1.1 marcus
473 1.1 marcus sc->sc_txbuf = p;
474 1.1 marcus sc->sc_txbuf_phys = SH3_P2SEG_TO_PHYS(p);
475 1.1 marcus
476 1.1 marcus sc->maple_commands_pending = 0;
477 1.1 marcus
478 1.1 marcus MAPLE_RESET = RESET_MAGIC;
479 1.1 marcus MAPLE_RESET2 = 0;
480 1.1 marcus
481 1.1 marcus MAPLE_SPEED = SPEED_2MBPS | TIMEOUT(50000);
482 1.1 marcus
483 1.1 marcus MAPLE_ENABLE = 1;
484 1.1 marcus
485 1.1 marcus maple_scanbus(sc);
486 1.1 marcus
487 1.1 marcus bzero(&sc->maple_callout_ch, sizeof(sc->maple_callout_ch));
488 1.1 marcus
489 1.1 marcus callout_reset(&sc->maple_callout_ch, MAPLE_CALLOUT_TICKS,
490 1.1 marcus (void *)maple_callout, sc);
491 1.1 marcus }
492 1.1 marcus
493 1.1 marcus int
494 1.1 marcus mapleprint(aux, pnp)
495 1.1 marcus void *aux;
496 1.1 marcus const char *pnp;
497 1.1 marcus {
498 1.1 marcus struct maple_attach_args *ma = aux;
499 1.1 marcus
500 1.1 marcus if (pnp != NULL)
501 1.4 thorpej printf("%.*s at %s",
502 1.4 thorpej (int)sizeof(ma->ma_devinfo->di_product_name),
503 1.4 thorpej ma->ma_devinfo->di_product_name, pnp);
504 1.1 marcus
505 1.4 thorpej printf(" port %d", ma->ma_port);
506 1.1 marcus
507 1.1 marcus if (ma->ma_subunit != 0)
508 1.4 thorpej printf(" subunit %d", ma->ma_subunit);
509 1.1 marcus
510 1.1 marcus return (UNCONF);
511 1.1 marcus }
512 1.1 marcus
513 1.4 thorpej static int
514 1.4 thorpej maplesubmatch(parent, match, aux)
515 1.1 marcus struct device *parent;
516 1.4 thorpej struct cfdata *match;
517 1.1 marcus void *aux;
518 1.1 marcus {
519 1.4 thorpej struct maple_attach_args *ma = aux;
520 1.1 marcus
521 1.4 thorpej if (match->cf_loc[MAPLECF_PORT] != MAPLECF_PORT_DEFAULT &&
522 1.4 thorpej match->cf_loc[MAPLECF_PORT] != ma->ma_port)
523 1.4 thorpej return (0);
524 1.4 thorpej
525 1.4 thorpej if (match->cf_loc[MAPLECF_SUBUNIT] != MAPLECF_SUBUNIT_DEFAULT &&
526 1.4 thorpej match->cf_loc[MAPLECF_SUBUNIT] != ma->ma_subunit)
527 1.4 thorpej return (0);
528 1.4 thorpej
529 1.4 thorpej return ((*match->cf_attach->ca_match)(parent, match, aux));
530 1.1 marcus }
531 1.1 marcus
532 1.1 marcus u_int32_t
533 1.1 marcus maple_get_function_data(devinfo, function_code)
534 1.1 marcus struct maple_devinfo *devinfo;
535 1.1 marcus u_int32_t function_code;
536 1.1 marcus {
537 1.1 marcus int i, p = 0;
538 1.1 marcus
539 1.1 marcus for (i = 31; i >= 0; --i)
540 1.1 marcus if (devinfo->di_func & (1U<<i))
541 1.1 marcus if (function_code & (1U<<i))
542 1.1 marcus return devinfo->di_function_data[p];
543 1.1 marcus else
544 1.1 marcus if (++p >= 3)
545 1.1 marcus break;
546 1.1 marcus return (0);
547 1.1 marcus }
548