xref: /netbsd-src/sys/arch/prep/pnpbus/pnpbus.c (revision c7fb772b85b2b5d4cfb282f868f454b4701534fd)
1 /*	$NetBSD: pnpbus.c,v 1.15 2021/08/07 16:19:03 thorpej Exp $	*/
2 
3 /*-
4  * Copyright (c) 1998 The NetBSD Foundation, Inc.
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to The NetBSD Foundation
8  * by Tim Rightnour
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29  * POSSIBILITY OF SUCH DAMAGE.
30  */
31 
32 #include <sys/cdefs.h>
33 __KERNEL_RCSID(0, "$NetBSD: pnpbus.c,v 1.15 2021/08/07 16:19:03 thorpej Exp $");
34 
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/device.h>
38 #include <sys/extent.h>
39 #include <sys/kmem.h>
40 
41 #include <sys/bus.h>
42 #include <machine/pio.h>
43 #include <machine/intr.h>
44 #include <machine/platform.h>
45 #include <machine/residual.h>
46 #include <machine/pnp.h>
47 #include <machine/isa_machdep.h>
48 #include <machine/chpidpnp.h>
49 
50 #include <dev/isa/isareg.h>
51 
52 #include <prep/pnpbus/pnpbusvar.h>
53 
54 #include "isadma.h"
55 
56 static int	pnpbus_match(device_t, cfdata_t, void *);
57 static void	pnpbus_attach(device_t, device_t, void *);
58 static int	pnpbus_print(void *, const char *);
59 static int	pnpbus_search(device_t, cfdata_t, const int *, void *);
60 
61 CFATTACH_DECL_NEW(pnpbus, sizeof(struct pnpbus_softc),
62     pnpbus_match, pnpbus_attach, NULL, NULL);
63 
64 struct pnpbus_softc *pnpbus_softc;
65 extern struct cfdriver pnpbus_cd;
66 
67 static int
pnpbus_match(device_t parent,cfdata_t cf,void * aux)68 pnpbus_match(device_t parent, cfdata_t cf, void *aux)
69 {
70 	struct pnpbus_attach_args *paa = aux;
71 
72 	if (paa->paa_name != NULL && strcmp(paa->paa_name, "pnpbus") == 0)
73 		return 1;
74 	return 0;
75 }
76 
77 static void
pnpbus_attach(device_t parent,device_t self,void * aux)78 pnpbus_attach(device_t parent, device_t self, void *aux)
79 {
80 	struct pnpbus_softc *sc = device_private(self);
81 	struct pnpbus_attach_args *paa = aux;
82 
83 	aprint_normal("\n");
84 
85 	pnpbus_softc = sc;
86 	sc->sc_dev = self;
87 	sc->sc_ic = paa->paa_ic;
88 	sc->sc_iot = paa->paa_iot;
89 	sc->sc_memt = paa->paa_memt;
90 	sc->sc_dmat = paa->paa_dmat;
91 
92 #if NISADMA > 0
93 	isa_dmainit(sc->sc_ic, sc->sc_iot, sc->sc_dmat, self);
94 #endif
95 
96 	config_search(self, aux,
97 	    CFARGS(.search = pnpbus_search));
98 }
99 
100 static int
pnp_newirq(void * v,struct pnpresources * r,int size)101 pnp_newirq(void *v, struct pnpresources *r, int size)
102 {
103 	struct _S4_Pack *p = v;
104 	struct pnpbus_irq *irq;
105 
106 	irq = kmem_alloc(sizeof(struct pnpbus_irq), KM_SLEEP);
107 
108 	irq->mask = le16dec(&p->IRQMask[0]);
109 
110 	if (size > 2)
111 		irq->flags = p->IRQInfo;
112 	else
113 		irq->flags = 0x1;
114 
115 	SIMPLEQ_INSERT_TAIL(&r->irq, irq, next);
116 	r->numirq++;
117 
118 	return 0;
119 }
120 
121 static int
pnp_newdma(void * v,struct pnpresources * r,int size)122 pnp_newdma(void *v, struct pnpresources *r, int size)
123 {
124 	struct _S5_Pack *p = v;
125 	struct pnpbus_dma *dma;
126 
127 	dma = kmem_alloc(sizeof(struct pnpbus_dma), KM_SLEEP);
128 
129 	dma->mask = le16dec(&p->DMAMask);
130 	if (size > 2)
131 		dma->flags = p->DMAInfo;
132 	else
133 		dma->flags = 0x01;
134 
135 	SIMPLEQ_INSERT_TAIL(&r->dma, dma, next);
136 	r->numdma++;
137 
138 	return 0;
139 }
140 
141 static int
pnp_newioport(void * v,struct pnpresources * r,int size)142 pnp_newioport(void *v, struct pnpresources *r, int size)
143 {
144 	struct _S8_Pack *p = v;
145 	struct pnpbus_io *io;
146 	uint16_t mask;
147 
148 	io = kmem_alloc(sizeof(struct pnpbus_io), KM_SLEEP);
149 	mask = p->IOInfo & ISAAddr16bit ? 0xffff : 0x03ff;
150 	io->minbase = (p->RangeMin[0] | (p->RangeMin[1] << 8)) & mask;
151 	io->maxbase = (p->RangeMax[0] | (p->RangeMax[1] << 8)) & mask;
152 	io->align = p->IOAlign;
153 	io->len = p->IONum;
154 	io->flags = p->IOInfo;
155 
156 	SIMPLEQ_INSERT_TAIL(&r->io, io, next);
157 	r->numio++;
158 
159 	return 0;
160 }
161 
162 static int
pnp_newfixedioport(void * v,struct pnpresources * r,int size)163 pnp_newfixedioport(void *v, struct pnpresources *r, int size)
164 {
165 	struct _S9_Pack *p = v;
166 	struct pnpbus_io *io;
167 
168 	io = kmem_alloc(sizeof(struct pnpbus_io), KM_SLEEP);
169 	io->minbase = (p->Range[0] | (p->Range[1] << 8)) & 0x3ff;
170 	io->len = p->IONum;
171 	io->maxbase = -1;
172 	io->flags = 0;
173 	io->align = 1;
174 
175 	SIMPLEQ_INSERT_TAIL(&r->io, io, next);
176 	r->numio++;
177 
178 	return 0;
179 }
180 
181 static int
pnp_newiomem(void * v,struct pnpresources * r,int size)182 pnp_newiomem(void *v, struct pnpresources *r, int size)
183 {
184 	struct pnpbus_mem *mem;
185 	struct _L1_Pack *pack = v;
186 
187 	if (pack->Count0 >= 0x9) {
188 		mem = kmem_alloc(sizeof(struct pnpbus_mem), KM_SLEEP);
189 		mem->minbase = (pack->Data[2] << 16) | (pack->Data[1] << 8);
190 		mem->maxbase = (pack->Data[4] << 16) | (pack->Data[3] << 8);
191 		mem->align = (pack->Data[6] << 8) | pack->Data[5];
192 		mem->len = (pack->Data[8] << 16) | (pack->Data[7] << 8);
193 		mem->flags = pack->Data[0];
194 		SIMPLEQ_INSERT_TAIL(&r->iomem, mem, next);
195 		r->numiomem++;
196 		return 0;
197 	}
198 	return -1;
199 }
200 
201 static int
pnp_newaddr(void * v,struct pnpresources * r,int size)202 pnp_newaddr(void *v, struct pnpresources *r, int size)
203 {
204 	struct pnpbus_io *io;
205 	struct pnpbus_mem *mem;
206 	struct _L4_Pack *pack = v;
207 	struct _L4_PPCPack *p =  &pack->L4_Data.L4_PPCPack;
208 
209 	if (p->PPCData[0] == 1) {/* type IO */
210 		io = kmem_alloc(sizeof(struct pnpbus_io), KM_SLEEP);
211 		io->minbase = (uint16_t)le64dec(&p->PPCData[4]);
212 		io->maxbase = -1;
213 		io->align = p->PPCData[1];
214 		io->len = (uint16_t)le64dec(&p->PPCData[12]);
215 		io->flags = 0;
216 		SIMPLEQ_INSERT_TAIL(&r->io, io, next);
217 		r->numio++;
218 
219 		return 0;
220 	} else if (p->PPCData[0] == 2) {
221 		mem = kmem_alloc(sizeof(struct pnpbus_mem), KM_SLEEP);
222 		mem->minbase = (uint32_t)le64dec(&p->PPCData[4]);
223 		mem->maxbase = -1;
224 		mem->align = p->PPCData[1];
225 		mem->len = (uint32_t)le64dec(&p->PPCData[12]);
226 		mem->flags = 0;
227 		SIMPLEQ_INSERT_TAIL(&r->mem, mem, next);
228 		r->nummem++;
229 
230 		return 0;
231 	} else
232 		return -1;
233 }
234 
235 static int
pnp_newcompatid(void * v,struct pnpresources * r,int size)236 pnp_newcompatid(void *v, struct pnpresources *r, int size)
237 {
238 	struct _S3_Pack *p = v;
239 	struct pnpbus_compatid *id;
240 	uint32_t cid;
241 
242 	id = kmem_alloc(sizeof(*id), KM_SLEEP);
243 	cid = le32dec(p->CompatId);
244 	pnp_devid_to_string(cid, id->idstr);
245 	id->next = r->compatids;
246 	r->compatids = id;
247 
248 	return 0;
249 }
250 
251 /*
252  * Call if match succeeds.  This way we don't allocate lots of ram
253  * for structures we never use if the device isn't attached.
254  */
255 
256 int
pnpbus_scan(struct pnpbus_dev_attach_args * pna,PPC_DEVICE * dev)257 pnpbus_scan(struct pnpbus_dev_attach_args *pna, PPC_DEVICE *dev)
258 {
259 	struct pnpresources *r = &pna->pna_res;
260 	uint32_t l;
261 	uint8_t *p, *q;
262 	void *v;
263 	int tag, size, item;
264 
265 	l = be32toh(dev->AllocatedOffset);
266 	p = res->DevicePnPHeap + l;
267 
268 	if (p == NULL)
269 		return -1;
270 
271 	for (; p[0] != END_TAG; p += size) {
272 		tag = *p;
273 		v = p;
274 		if (tag_type(p[0]) == PNP_SMALL) {
275 			size = tag_small_count(tag) + 1;
276 			item = tag_small_item_name(tag);
277 			switch (item) {
278 			case IRQFormat:
279 				pnp_newirq(v, r, size);
280 				break;
281 			case DMAFormat:
282 				pnp_newdma(v, r, size);
283 				break;
284 			case IOPort:
285 				pnp_newioport(v, r, size);
286 				break;
287 			case FixedIOPort:
288 				pnp_newfixedioport(v, r, size);
289 				break;
290 			}
291 		} else {
292 			struct _L4_Pack *pack = v;
293 			struct _L4_PPCPack *pa = &pack->L4_Data.L4_PPCPack;
294 
295 			q = p;
296 			size = (q[1] | (q[2] << 8)) + 3 /* tag + length */;
297 			item = tag_large_item_name(tag);
298 			if (item == LargeVendorItem &&
299 			    pa->Type == LV_GenericAddress)
300 				pnp_newaddr(v, r, size);
301 			else if (item == MemoryRange)
302 				pnp_newiomem(v, r, size);
303 		}
304 	}
305 
306 	/* scan for compatid's */
307 
308 	l = be32toh(dev->CompatibleOffset);
309 	p = res->DevicePnPHeap + l;
310 
311 	if (p == NULL)
312 		return -1;
313 
314 	for (; p[0] != END_TAG; p += size) {
315 		tag = *p;
316 		v = p;
317 		if (tag_type(p[0]) == PNP_SMALL) {
318 			size = tag_small_count(tag) + 1;
319 			item = tag_small_item_name(tag);
320 			switch (item) {
321 			case CompatibleDevice:
322 				pnp_newcompatid(v, r, size);
323 				break;
324 			}
325 		} else {
326 			q = p;
327 			size = (q[1] | (q[2] << 8)) + 3 /* tag + length */;
328 		}
329 	}
330 	return 0;
331 }
332 
333 /*
334  * Setup the basic pna structure.
335  */
336 
337 static void
pnp_getpna(struct pnpbus_dev_attach_args * pna,struct pnpbus_attach_args * paa,PPC_DEVICE * dev)338 pnp_getpna(struct pnpbus_dev_attach_args *pna, struct pnpbus_attach_args *paa,
339 	PPC_DEVICE *dev)
340 {
341 	DEVICE_ID *id = &dev->DeviceId;
342 	struct pnpresources *r = &pna->pna_res;
343 	ChipIDPack *pack;
344 	uint32_t l;
345 	uint8_t *p;
346 	void *v;
347 	int tag, size, item;
348 
349 	l = be32toh(dev->AllocatedOffset);
350 	p = res->DevicePnPHeap + l;
351 
352 	pna->pna_iot = paa->paa_iot;
353 	pna->pna_memt = paa->paa_memt;
354 	pna->pna_ic = paa->paa_ic;
355 	pna->pna_dmat = paa->paa_dmat;
356 	pnp_devid_to_string(id->DevId, pna->pna_devid);
357 	pna->basetype = id->BaseType;
358 	pna->subtype = id->SubType;
359 	pna->interface = id->Interface;
360 	pna->pna_ppc_dev = dev;
361 	memset(r, 0, sizeof(*r));
362 	SIMPLEQ_INIT(&r->mem);
363 	SIMPLEQ_INIT(&r->io);
364 	SIMPLEQ_INIT(&r->irq);
365 	SIMPLEQ_INIT(&r->dma);
366 	SIMPLEQ_INIT(&r->iomem);
367 	if (p == NULL)
368 		return;
369 	/* otherwise, we start looking for chipid's */
370 	for (; p[0] != END_TAG; p += size) {
371 		tag = *p;
372 		v = p;
373 		if (tag_type(p[0]) == PNP_SMALL) {
374 			size = tag_small_count(tag) + 1;
375 			item = tag_small_item_name(tag);
376 			if (item != SmallVendorItem || p[1] != 1)
377 				continue;
378 			pack = v;
379 			pna->chipid = le16dec(&pack->Name[0]);
380 			pna->chipmfg0 = pack->VendorID0;
381 			pna->chipmfg1 = pack->VendorID1;
382 			break;
383 		} else {
384 			/* Large */
385 			size = (p[1] | (p[2] << 8)) + 3 /* tag + length */;
386 		}
387 	}
388 }
389 
390 static int
pnpbus_search(device_t parent,cfdata_t cf,const int * ldesc,void * aux)391 pnpbus_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
392 {
393 	struct pnpbus_dev_attach_args pna;
394 	struct pnpbus_attach_args *paa = aux;
395 	PPC_DEVICE *ppc_dev;
396 	int i;
397 	uint32_t ndev;
398 
399 	ndev = be32toh(res->ActualNumDevices);
400 	ppc_dev = res->Devices;
401 
402 	for (i = 0; i < ((ndev > MAX_DEVICES) ? MAX_DEVICES : ndev); i++) {
403 		pnp_getpna(&pna, paa, &ppc_dev[i]);
404 		if (config_probe(parent, cf, &pna))
405 			config_attach(parent, cf, &pna, pnpbus_print,
406 			    CFARGS_NONE);
407 	}
408 
409 	return 0;
410 }
411 
412 static void
pnpbus_printres(struct pnpresources * r)413 pnpbus_printres(struct pnpresources *r)
414 {
415 	struct pnpbus_io *io;
416 	struct pnpbus_mem *mem;
417 	struct pnpbus_irq *irq;
418 	struct pnpbus_dma *dma;
419 	int p = 0;
420 
421 	if (!SIMPLEQ_EMPTY(&r->mem)) {
422 		aprint_normal("mem");
423 		SIMPLEQ_FOREACH(mem, &r->mem, next) {
424 			aprint_normal(" 0x%x", mem->minbase);
425 			if (mem->len > 1)
426 				aprint_normal("-0x%x",
427 				    mem->minbase + mem->len - 1);
428 		}
429 		p++;
430 	}
431 	if (!SIMPLEQ_EMPTY(&r->io)) {
432 		if (p++)
433 			aprint_normal(", ");
434 		aprint_normal("port");
435 		SIMPLEQ_FOREACH(io, &r->io, next) {
436 			aprint_normal(" 0x%x", io->minbase);
437 			if (io->len > 1)
438 				aprint_normal("-0x%x",
439 				    io->minbase + io->len - 1);
440 		}
441 	}
442 	if (!SIMPLEQ_EMPTY(&r->iomem)) {
443 		if (p++)
444 			aprint_normal(", ");
445 		aprint_normal("iomem");
446 		SIMPLEQ_FOREACH(mem, &r->iomem, next) {
447 			aprint_normal(" 0x%x", mem->minbase);
448 			if (mem->len > 1)
449 				aprint_normal("-0x%x",
450 				    mem->minbase + mem->len - 1);
451 		}
452 		p++;
453 	}
454 	if (!SIMPLEQ_EMPTY(&r->irq)) {
455 		if (p++)
456 			aprint_normal(", ");
457 		aprint_normal("irq");
458 		SIMPLEQ_FOREACH(irq, &r->irq, next) {
459 			aprint_normal(" %d", ffs(irq->mask) - 1);
460 		}
461 	}
462 	if (!SIMPLEQ_EMPTY(&r->dma)) {
463 		if (p++)
464 			aprint_normal(", ");
465 		aprint_normal("DMA");
466 		SIMPLEQ_FOREACH(dma, &r->dma, next) {
467 			aprint_normal(" %d", ffs(dma->mask) - 1);
468 		}
469 	}
470 }
471 
472 void
pnpbus_print_devres(struct pnpbus_dev_attach_args * pna)473 pnpbus_print_devres(struct pnpbus_dev_attach_args *pna)
474 {
475 	aprint_normal(": ");
476 	pnpbus_printres(&pna->pna_res);
477 }
478 
479 static int
pnpbus_print(void * args,const char * name)480 pnpbus_print(void *args, const char *name)
481 {
482 	struct pnpbus_dev_attach_args *pna = args;
483 
484 	pnpbus_print_devres(pna);
485 	return (UNCONF);
486 }
487 
488 /*
489  * Set up an interrupt handler to start being called.
490  */
491 void *
pnpbus_intr_establish(int idx,int level,int tover,int (* ih_fun)(void *),void * ih_arg,struct pnpresources * r)492 pnpbus_intr_establish(int idx, int level, int tover, int (*ih_fun)(void *),
493     void *ih_arg, struct pnpresources *r)
494 {
495 	struct pnpbus_irq *irq;
496 	int irqnum, type;
497 
498 	if (idx >= r->numirq)
499 		return 0;
500 
501 	irq = SIMPLEQ_FIRST(&r->irq);
502 	while (idx--)
503 		irq = SIMPLEQ_NEXT(irq, next);
504 
505 	irqnum = ffs(irq->mask) - 1;
506 	type = (irq->flags & 0x0c) ? IST_LEVEL : IST_EDGE;
507 	if (tover != IST_PNP)
508 		type = tover;
509 
510 	return (void *)intr_establish(irqnum, type, level, ih_fun, ih_arg);
511 }
512 
513 /*
514  * Deregister an interrupt handler.
515  */
516 void
pnpbus_intr_disestablish(void * arg)517 pnpbus_intr_disestablish(void *arg)
518 {
519 
520 	intr_disestablish(arg);
521 }
522 
523 int
pnpbus_getirqnum(struct pnpresources * r,int idx,int * irqp,int * istp)524 pnpbus_getirqnum(struct pnpresources *r, int idx, int *irqp, int *istp)
525 {
526 	struct pnpbus_irq *irq;
527 
528 	if (idx >= r->numirq)
529 		return EINVAL;
530 
531 	irq = SIMPLEQ_FIRST(&r->irq);
532 	while (idx--)
533 		irq = SIMPLEQ_NEXT(irq, next);
534 
535 	if (irqp != NULL)
536 		*irqp = ffs(irq->mask) - 1;
537 	if (istp != NULL)
538 		*istp = (irq->flags &0x0c) ? IST_LEVEL : IST_EDGE;
539 	return 0;
540 }
541 
542 int
pnpbus_getdmachan(struct pnpresources * r,int idx,int * chanp)543 pnpbus_getdmachan(struct pnpresources *r, int idx, int *chanp)
544 {
545 	struct pnpbus_dma *dma;
546 
547 	if (idx >= r->numdma)
548 		return EINVAL;
549 
550 	dma = SIMPLEQ_FIRST(&r->dma);
551 	while (idx--)
552 		dma = SIMPLEQ_NEXT(dma, next);
553 
554 	if (chanp != NULL)
555 		*chanp = ffs(dma->mask) - 1;
556 	return 0;
557 }
558 
559 int
pnpbus_getioport(struct pnpresources * r,int idx,int * basep,int * sizep)560 pnpbus_getioport(struct pnpresources *r, int idx, int *basep, int *sizep)
561 {
562 	struct pnpbus_io *io;
563 
564 	if (idx >= r->numio)
565 		return EINVAL;
566 
567 	io = SIMPLEQ_FIRST(&r->io);
568 	while (idx--)
569 		io = SIMPLEQ_NEXT(io, next);
570 
571 	if (basep)
572 		*basep = io->minbase;
573 	if (sizep)
574 		*sizep = io->len;
575 	return 0;
576 }
577 
578 int
pnpbus_io_map(struct pnpresources * r,int idx,bus_space_tag_t * tagp,bus_space_handle_t * hdlp)579 pnpbus_io_map(struct pnpresources *r, int idx, bus_space_tag_t *tagp,
580     bus_space_handle_t *hdlp)
581 {
582 	struct pnpbus_io *io;
583 
584 	if (idx >= r->numio)
585 		return EINVAL;
586 
587 	io = SIMPLEQ_FIRST(&r->io);
588 	while (idx--)
589 		io = SIMPLEQ_NEXT(io, next);
590 
591 	*tagp = &genppc_isa_io_space_tag;
592 	return (bus_space_map(&genppc_isa_io_space_tag, io->minbase, io->len,
593 	    0, hdlp));
594 }
595 
596 void
pnpbus_io_unmap(struct pnpresources * r,int idx,bus_space_tag_t tag,bus_space_handle_t hdl)597 pnpbus_io_unmap(struct pnpresources *r, int idx, bus_space_tag_t tag,
598     bus_space_handle_t hdl)
599 {
600 	struct pnpbus_io *io;
601 
602 	if (idx >= r->numio)
603 		return;
604 
605 	io = SIMPLEQ_FIRST(&r->io);
606 	while (idx--)
607 		io = SIMPLEQ_NEXT(io, next);
608 
609 	bus_space_unmap(tag, hdl, io->len);
610 }
611 
612 int
pnpbus_getiomem(struct pnpresources * r,int idx,int * basep,int * sizep)613 pnpbus_getiomem(struct pnpresources *r, int idx, int *basep, int *sizep)
614 {
615 	struct pnpbus_mem *mem;
616 
617 	if (idx >= r->numiomem)
618 		return EINVAL;
619 
620 	mem = SIMPLEQ_FIRST(&r->iomem);
621 	while (idx--)
622 		mem = SIMPLEQ_NEXT(mem, next);
623 
624 	if (basep)
625 		*basep = mem->minbase;
626 	if (sizep)
627 		*sizep = mem->len;
628 	return 0;
629 }
630 
631 int
pnpbus_iomem_map(struct pnpresources * r,int idx,bus_space_tag_t * tagp,bus_space_handle_t * hdlp)632 pnpbus_iomem_map(struct pnpresources *r, int idx, bus_space_tag_t *tagp,
633     bus_space_handle_t *hdlp)
634 {
635 	struct pnpbus_mem *mem;
636 
637 	if (idx >= r->numiomem)
638 		return EINVAL;
639 
640 	mem = SIMPLEQ_FIRST(&r->iomem);
641 	while (idx--)
642 		mem = SIMPLEQ_NEXT(mem, next);
643 
644 	*tagp = &genppc_isa_mem_space_tag;
645 	return (bus_space_map(&genppc_isa_mem_space_tag, mem->minbase, mem->len,
646 	    0, hdlp));
647 }
648 
649 void
pnpbus_iomem_unmap(struct pnpresources * r,int idx,bus_space_tag_t tag,bus_space_handle_t hdl)650 pnpbus_iomem_unmap(struct pnpresources *r, int idx, bus_space_tag_t tag,
651     bus_space_handle_t hdl)
652 {
653 	struct pnpbus_mem *mem;
654 
655 	if (idx >= r->numiomem)
656 		return;
657 
658 	mem = SIMPLEQ_FIRST(&r->mem);
659 	while (idx--)
660 		mem = SIMPLEQ_NEXT(mem, next);
661 
662 	bus_space_unmap(tag, hdl, mem->len);
663 }
664