Initial import from FreeBSD RELENG_4:
[dragonfly.git] / sys / bus / isa / isa_common.c
CommitLineData
984263bc
MD
1/*-
2 * Copyright (c) 1999 Doug Rabson
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 * $FreeBSD: src/sys/isa/isa_common.c,v 1.16.2.1 2000/09/16 15:49:52 roger Exp $
27 */
28/*
29 * Modifications for Intel architecture by Garrett A. Wollman.
30 * Copyright 1998 Massachusetts Institute of Technology
31 *
32 * Permission to use, copy, modify, and distribute this software and
33 * its documentation for any purpose and without fee is hereby
34 * granted, provided that both the above copyright notice and this
35 * permission notice appear in all copies, that both the above
36 * copyright notice and this permission notice appear in all
37 * supporting documentation, and that the name of M.I.T. not be used
38 * in advertising or publicity pertaining to distribution of the
39 * software without specific, written prior permission. M.I.T. makes
40 * no representations about the suitability of this software for any
41 * purpose. It is provided "as is" without express or implied
42 * warranty.
43 *
44 * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS
45 * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE,
46 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
47 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT
48 * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
49 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
50 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
51 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
52 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
53 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
54 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
55 * SUCH DAMAGE.
56 */
57
58/*
59 * Parts of the ISA bus implementation common to all architectures.
60 */
61
62#include <sys/param.h>
63#include <sys/systm.h>
64#include <sys/kernel.h>
65#include <sys/bus.h>
66#include <sys/malloc.h>
67#include <sys/module.h>
68#include <machine/bus.h>
69#include <sys/rman.h>
70
71#include <machine/resource.h>
72
73#include <isa/isavar.h>
74#include <isa/isa_common.h>
75#ifdef __alpha__ /* XXX workaround a stupid warning */
76#include <alpha/isa/isavar.h>
77#endif
78
79static int isa_print_child __P((device_t, device_t));
80
81MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device");
82
83static devclass_t isa_devclass;
84static int isa_running;
85
86/*
87 * At 'probe' time, we add all the devices which we know about to the
88 * bus. The generic attach routine will probe and attach them if they
89 * are alive.
90 */
91static int
92isa_probe(device_t dev)
93{
94 device_set_desc(dev, "ISA bus");
95 isa_init(); /* Allow machdep code to initialise */
96 return 0;
97}
98
99extern device_t isa_bus_device;
100
101static int
102isa_attach(device_t dev)
103{
104 /*
105 * Arrange for isa_probe_children(dev) to be called later. XXX
106 */
107 isa_bus_device = dev;
108 return 0;
109}
110
111/*
112 * Find a working set of memory regions for a child using the ranges
113 * in *config and return the regions in *result. Returns non-zero if
114 * a set of ranges was found.
115 */
116static int
117isa_find_memory(device_t child,
118 struct isa_config *config,
119 struct isa_config *result)
120{
121 int success, i;
122 struct resource *res[ISA_NMEM];
123
124 /*
125 * First clear out any existing resource definitions.
126 */
127 for (i = 0; i < ISA_NMEM; i++) {
128 bus_delete_resource(child, SYS_RES_MEMORY, i);
129 res[i] = NULL;
130 }
131
132 success = 1;
133 result->ic_nmem = config->ic_nmem;
134 for (i = 0; i < config->ic_nmem; i++) {
135 u_int32_t start, end, size, align;
136 for (start = config->ic_mem[i].ir_start,
137 end = config->ic_mem[i].ir_end,
138 size = config->ic_mem[i].ir_size,
139 align = config->ic_mem[i].ir_align;
140 start + size - 1 <= end;
141 start += align) {
142 bus_set_resource(child, SYS_RES_MEMORY, i,
143 start, size);
144 res[i] = bus_alloc_resource(child,
145 SYS_RES_MEMORY, &i,
146 0, ~0, 1, 0 /* !RF_ACTIVE */);
147 if (res[i]) {
148 result->ic_mem[i].ir_start = start;
149 result->ic_mem[i].ir_end = start + size - 1;
150 result->ic_mem[i].ir_size = size;
151 result->ic_mem[i].ir_align = align;
152 break;
153 }
154 }
155
156 /*
157 * If we didn't find a place for memory range i, then
158 * give up now.
159 */
160 if (!res[i]) {
161 success = 0;
162 break;
163 }
164 }
165
166 for (i = 0; i < ISA_NMEM; i++) {
167 if (res[i])
168 bus_release_resource(child, SYS_RES_MEMORY,
169 i, res[i]);
170 }
171
172 return success;
173}
174
175/*
176 * Find a working set of port regions for a child using the ranges
177 * in *config and return the regions in *result. Returns non-zero if
178 * a set of ranges was found.
179 */
180static int
181isa_find_port(device_t child,
182 struct isa_config *config,
183 struct isa_config *result)
184{
185 int success, i;
186 struct resource *res[ISA_NPORT];
187
188 /*
189 * First clear out any existing resource definitions.
190 */
191 for (i = 0; i < ISA_NPORT; i++) {
192 bus_delete_resource(child, SYS_RES_IOPORT, i);
193 res[i] = NULL;
194 }
195
196 success = 1;
197 result->ic_nport = config->ic_nport;
198 for (i = 0; i < config->ic_nport; i++) {
199 u_int32_t start, end, size, align;
200 for (start = config->ic_port[i].ir_start,
201 end = config->ic_port[i].ir_end,
202 size = config->ic_port[i].ir_size,
203 align = config->ic_port[i].ir_align;
204 start + size - 1 <= end;
205 start += align) {
206 bus_set_resource(child, SYS_RES_IOPORT, i,
207 start, size);
208 res[i] = bus_alloc_resource(child,
209 SYS_RES_IOPORT, &i,
210 0, ~0, 1, 0 /* !RF_ACTIVE */);
211 if (res[i]) {
212 result->ic_port[i].ir_start = start;
213 result->ic_port[i].ir_end = start + size - 1;
214 result->ic_port[i].ir_size = size;
215 result->ic_port[i].ir_align = align;
216 break;
217 }
218 }
219
220 /*
221 * If we didn't find a place for port range i, then
222 * give up now.
223 */
224 if (!res[i]) {
225 success = 0;
226 break;
227 }
228 }
229
230 for (i = 0; i < ISA_NPORT; i++) {
231 if (res[i])
232 bus_release_resource(child, SYS_RES_IOPORT,
233 i, res[i]);
234 }
235
236 return success;
237}
238
239/*
240 * Return the index of the first bit in the mask (or -1 if mask is empty.
241 */
242static int
243find_first_bit(u_int32_t mask)
244{
245 return ffs(mask) - 1;
246}
247
248/*
249 * Return the index of the next bit in the mask, or -1 if there are no more.
250 */
251static int
252find_next_bit(u_int32_t mask, int bit)
253{
254 bit++;
255 while (bit < 32 && !(mask & (1 << bit)))
256 bit++;
257 if (bit != 32)
258 return bit;
259 return -1;
260}
261
262/*
263 * Find a working set of irqs for a child using the masks in *config
264 * and return the regions in *result. Returns non-zero if a set of
265 * irqs was found.
266 */
267static int
268isa_find_irq(device_t child,
269 struct isa_config *config,
270 struct isa_config *result)
271{
272 int success, i;
273 struct resource *res[ISA_NIRQ];
274
275 /*
276 * First clear out any existing resource definitions.
277 */
278 for (i = 0; i < ISA_NIRQ; i++) {
279 bus_delete_resource(child, SYS_RES_IRQ, i);
280 res[i] = NULL;
281 }
282
283 success = 1;
284 result->ic_nirq = config->ic_nirq;
285 for (i = 0; i < config->ic_nirq; i++) {
286 u_int32_t mask = config->ic_irqmask[i];
287 int irq;
288 for (irq = find_first_bit(mask);
289 irq != -1;
290 irq = find_next_bit(mask, irq)) {
291 bus_set_resource(child, SYS_RES_IRQ, i,
292 irq, 1);
293 res[i] = bus_alloc_resource(child,
294 SYS_RES_IRQ, &i,
295 0, ~0, 1, 0 /* !RF_ACTIVE */ );
296 if (res[i]) {
297 result->ic_irqmask[i] = (1 << irq);
298 break;
299 }
300 }
301
302 /*
303 * If we didn't find a place for irq range i, then
304 * give up now.
305 */
306 if (!res[i]) {
307 success = 0;
308 break;
309 }
310 }
311
312 for (i = 0; i < ISA_NIRQ; i++) {
313 if (res[i])
314 bus_release_resource(child, SYS_RES_IRQ,
315 i, res[i]);
316 }
317
318 return success;
319}
320
321/*
322 * Find a working set of drqs for a child using the masks in *config
323 * and return the regions in *result. Returns non-zero if a set of
324 * drqs was found.
325 */
326static int
327isa_find_drq(device_t child,
328 struct isa_config *config,
329 struct isa_config *result)
330{
331 int success, i;
332 struct resource *res[ISA_NDRQ];
333
334 /*
335 * First clear out any existing resource definitions.
336 */
337 for (i = 0; i < ISA_NDRQ; i++) {
338 bus_delete_resource(child, SYS_RES_DRQ, i);
339 res[i] = NULL;
340 }
341
342 success = 1;
343 result->ic_ndrq = config->ic_ndrq;
344 for (i = 0; i < config->ic_ndrq; i++) {
345 u_int32_t mask = config->ic_drqmask[i];
346 int drq;
347 for (drq = find_first_bit(mask);
348 drq != -1;
349 drq = find_next_bit(mask, drq)) {
350 bus_set_resource(child, SYS_RES_DRQ, i,
351 drq, 1);
352 res[i] = bus_alloc_resource(child,
353 SYS_RES_DRQ, &i,
354 0, ~0, 1, 0 /* !RF_ACTIVE */);
355 if (res[i]) {
356 result->ic_drqmask[i] = (1 << drq);
357 break;
358 }
359 }
360
361 /*
362 * If we didn't find a place for drq range i, then
363 * give up now.
364 */
365 if (!res[i]) {
366 success = 0;
367 break;
368 }
369 }
370
371 for (i = 0; i < ISA_NDRQ; i++) {
372 if (res[i])
373 bus_release_resource(child, SYS_RES_DRQ,
374 i, res[i]);
375 }
376
377 return success;
378}
379
380/*
381 * Attempt to find a working set of resources for a device. Return
382 * non-zero if a working configuration is found.
383 */
384static int
385isa_assign_resources(device_t child)
386{
387 struct isa_device *idev = DEVTOISA(child);
388 struct isa_config_entry *ice;
389 struct isa_config config;
390
391 bzero(&config, sizeof config);
392 TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
393 if (!isa_find_memory(child, &ice->ice_config, &config))
394 continue;
395 if (!isa_find_port(child, &ice->ice_config, &config))
396 continue;
397 if (!isa_find_irq(child, &ice->ice_config, &config))
398 continue;
399 if (!isa_find_drq(child, &ice->ice_config, &config))
400 continue;
401
402 /*
403 * A working configuration was found enable the device
404 * with this configuration.
405 */
406 if (idev->id_config_cb) {
407 idev->id_config_cb(idev->id_config_arg,
408 &config, 1);
409 return 1;
410 }
411 }
412
413 /*
414 * Disable the device.
415 */
416 bus_print_child_header(device_get_parent(child), child);
417 printf(" can't assign resources\n");
418 if (bootverbose)
419 isa_print_child(device_get_parent(child), child);
420 bzero(&config, sizeof config);
421 if (idev->id_config_cb)
422 idev->id_config_cb(idev->id_config_arg, &config, 0);
423 device_disable(child);
424
425 return 0;
426}
427
428/*
429 * Called after other devices have initialised to probe for isa devices.
430 */
431void
432isa_probe_children(device_t dev)
433{
434 device_t *children;
435 int nchildren, i;
436
437 /*
438 * Create all the children by calling driver's identify methods.
439 */
440 bus_generic_probe(dev);
441
442 if (device_get_children(dev, &children, &nchildren))
443 return;
444
445 /*
446 * First disable all pnp devices so that they don't get
447 * matched by legacy probes.
448 */
449 if (bootverbose)
450 printf("isa_probe_children: disabling PnP devices\n");
451 for (i = 0; i < nchildren; i++) {
452 device_t child = children[i];
453 struct isa_device *idev = DEVTOISA(child);
454 struct isa_config config;
455
456 bzero(&config, sizeof config);
457 if (idev->id_config_cb)
458 idev->id_config_cb(idev->id_config_arg, &config, 0);
459 }
460
461 /*
462 * Next probe all non-pnp devices so that they claim their
463 * resources first.
464 */
465 if (bootverbose)
466 printf("isa_probe_children: probing non-PnP devices\n");
467 for (i = 0; i < nchildren; i++) {
468 device_t child = children[i];
469 struct isa_device *idev = DEVTOISA(child);
470
471 if (TAILQ_FIRST(&idev->id_configs))
472 continue;
473
474 device_probe_and_attach(child);
475 }
476
477 /*
478 * Finally assign resource to pnp devices and probe them.
479 */
480 if (bootverbose)
481 printf("isa_probe_children: probing PnP devices\n");
482 for (i = 0; i < nchildren; i++) {
483 device_t child = children[i];
484 struct isa_device* idev = DEVTOISA(child);
485
486 if (!TAILQ_FIRST(&idev->id_configs))
487 continue;
488
489 if (isa_assign_resources(child)) {
490 struct resource_list *rl = &idev->id_resources;
491 struct resource_list_entry *rle;
492
493 device_probe_and_attach(child);
494
495 /*
496 * Claim any unallocated resources to keep other
497 * devices from using them.
498 */
499 SLIST_FOREACH(rle, rl, link) {
500 if (!rle->res) {
501 int rid = rle->rid;
502 resource_list_alloc(rl, dev, child,
503 rle->type,
504 &rid,
505 0, ~0, 1,
506 0 /* !RF_ACTIVE */);
507 }
508 }
509 }
510 }
511
512 free(children, M_TEMP);
513
514 isa_running = 1;
515}
516
517/*
518 * Add a new child with default ivars.
519 */
520static device_t
521isa_add_child(device_t dev, int order, const char *name, int unit)
522{
523 device_t child;
524 struct isa_device *idev;
525
526 idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT);
527 if (!idev)
528 return 0;
529 bzero(idev, sizeof *idev);
530
531 resource_list_init(&idev->id_resources);
532 TAILQ_INIT(&idev->id_configs);
533
534 child = device_add_child_ordered(dev, order, name, unit);
535 device_set_ivars(child, idev);
536
537 return child;
538}
539
540static int
541isa_print_resources(struct resource_list *rl, const char *name, int type,
542 int count, const char *format)
543{
544 struct resource_list_entry *rle;
545 int printed;
546 int i, retval = 0;;
547
548 printed = 0;
549 for (i = 0; i < count; i++) {
550 rle = resource_list_find(rl, type, i);
551 if (rle) {
552 if (printed == 0)
553 retval += printf(" %s ", name);
554 else if (printed > 0)
555 retval += printf(",");
556 printed++;
557 retval += printf(format, rle->start);
558 if (rle->count > 1) {
559 retval += printf("-");
560 retval += printf(format,
561 rle->start + rle->count - 1);
562 }
563 } else if (i > 3) {
564 /* check the first few regardless */
565 break;
566 }
567 }
568 return retval;
569}
570
571static int
572isa_print_all_resources(device_t dev)
573{
574 struct isa_device *idev = DEVTOISA(dev);
575 struct resource_list *rl = &idev->id_resources;
576 int retval = 0;
577
578 if (SLIST_FIRST(rl) || device_get_flags(dev))
579 retval += printf(" at");
580
581 retval += isa_print_resources(rl, "port", SYS_RES_IOPORT,
582 ISA_NPORT, "%#lx");
583 retval += isa_print_resources(rl, "iomem", SYS_RES_MEMORY,
584 ISA_NMEM, "%#lx");
585 retval += isa_print_resources(rl, "irq", SYS_RES_IRQ,
586 ISA_NIRQ, "%ld");
587 retval += isa_print_resources(rl, "drq", SYS_RES_DRQ,
588 ISA_NDRQ, "%ld");
589 if (device_get_flags(dev))
590 retval += printf(" flags %#x", device_get_flags(dev));
591
592 return retval;
593}
594
595static int
596isa_print_child(device_t bus, device_t dev)
597{
598 int retval = 0;
599
600 retval += bus_print_child_header(bus, dev);
601 retval += isa_print_all_resources(dev);
602 retval += bus_print_child_footer(bus, dev);
603
604 return (retval);
605}
606
607static void
608isa_probe_nomatch(device_t dev, device_t child)
609{
610 if (bootverbose) {
611 bus_print_child_header(dev, child);
612 printf(" failed to probe");
613 isa_print_all_resources(child);
614 bus_print_child_footer(dev, child);
615 }
616
617 return;
618}
619
620static int
621isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result)
622{
623 struct isa_device* idev = DEVTOISA(dev);
624 struct resource_list *rl = &idev->id_resources;
625 struct resource_list_entry *rle;
626
627 switch (index) {
628 case ISA_IVAR_PORT_0:
629 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
630 if (rle)
631 *result = rle->start;
632 else
633 *result = -1;
634 break;
635
636 case ISA_IVAR_PORT_1:
637 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
638 if (rle)
639 *result = rle->start;
640 else
641 *result = -1;
642 break;
643
644 case ISA_IVAR_PORTSIZE_0:
645 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
646 if (rle)
647 *result = rle->count;
648 else
649 *result = 0;
650 break;
651
652 case ISA_IVAR_PORTSIZE_1:
653 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
654 if (rle)
655 *result = rle->count;
656 else
657 *result = 0;
658 break;
659
660 case ISA_IVAR_MADDR_0:
661 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
662 if (rle)
663 *result = rle->start;
664 else
665 *result = -1;
666 break;
667
668 case ISA_IVAR_MADDR_1:
669 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
670 if (rle)
671 *result = rle->start;
672 else
673 *result = -1;
674 break;
675
676 case ISA_IVAR_MSIZE_0:
677 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
678 if (rle)
679 *result = rle->count;
680 else
681 *result = 0;
682 break;
683
684 case ISA_IVAR_MSIZE_1:
685 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
686 if (rle)
687 *result = rle->count;
688 else
689 *result = 0;
690 break;
691
692 case ISA_IVAR_IRQ_0:
693 rle = resource_list_find(rl, SYS_RES_IRQ, 0);
694 if (rle)
695 *result = rle->start;
696 else
697 *result = -1;
698 break;
699
700 case ISA_IVAR_IRQ_1:
701 rle = resource_list_find(rl, SYS_RES_IRQ, 1);
702 if (rle)
703 *result = rle->start;
704 else
705 *result = -1;
706 break;
707
708 case ISA_IVAR_DRQ_0:
709 rle = resource_list_find(rl, SYS_RES_DRQ, 0);
710 if (rle)
711 *result = rle->start;
712 else
713 *result = -1;
714 break;
715
716 case ISA_IVAR_DRQ_1:
717 rle = resource_list_find(rl, SYS_RES_DRQ, 1);
718 if (rle)
719 *result = rle->start;
720 else
721 *result = -1;
722 break;
723
724 case ISA_IVAR_VENDORID:
725 *result = idev->id_vendorid;
726 break;
727
728 case ISA_IVAR_SERIAL:
729 *result = idev->id_serial;
730 break;
731
732 case ISA_IVAR_LOGICALID:
733 *result = idev->id_logicalid;
734 break;
735
736 case ISA_IVAR_COMPATID:
737 *result = idev->id_compatid;
738 break;
739
740 default:
741 return ENOENT;
742 }
743
744 return 0;
745}
746
747static int
748isa_write_ivar(device_t bus, device_t dev,
749 int index, uintptr_t value)
750{
751 struct isa_device* idev = DEVTOISA(dev);
752
753 switch (index) {
754 case ISA_IVAR_PORT_0:
755 case ISA_IVAR_PORT_1:
756 case ISA_IVAR_PORTSIZE_0:
757 case ISA_IVAR_PORTSIZE_1:
758 case ISA_IVAR_MADDR_0:
759 case ISA_IVAR_MADDR_1:
760 case ISA_IVAR_MSIZE_0:
761 case ISA_IVAR_MSIZE_1:
762 case ISA_IVAR_IRQ_0:
763 case ISA_IVAR_IRQ_1:
764 case ISA_IVAR_DRQ_0:
765 case ISA_IVAR_DRQ_1:
766 return EINVAL;
767
768 case ISA_IVAR_VENDORID:
769 idev->id_vendorid = value;
770 break;
771
772 case ISA_IVAR_SERIAL:
773 idev->id_serial = value;
774 break;
775
776 case ISA_IVAR_LOGICALID:
777 idev->id_logicalid = value;
778 break;
779
780 case ISA_IVAR_COMPATID:
781 idev->id_compatid = value;
782 break;
783
784 default:
785 return (ENOENT);
786 }
787
788 return (0);
789}
790
791/*
792 * Free any resources which the driver missed or which we were holding for
793 * it (see isa_probe_children).
794 */
795static void
796isa_child_detached(device_t dev, device_t child)
797{
798 struct isa_device* idev = DEVTOISA(child);
799 struct resource_list *rl = &idev->id_resources;
800 struct resource_list_entry *rle;
801
802 if (TAILQ_FIRST(&idev->id_configs)) {
803 /*
804 * Claim any unallocated resources to keep other
805 * devices from using them.
806 */
807 SLIST_FOREACH(rle, rl, link) {
808 if (!rle->res) {
809 int rid = rle->rid;
810 resource_list_alloc(rl, dev, child,
811 rle->type,
812 &rid, 0, ~0, 1, 0);
813 }
814 }
815 }
816}
817
818static void
819isa_driver_added(device_t dev, driver_t *driver)
820{
821 device_t *children;
822 int nchildren, i;
823
824 /*
825 * Don't do anything if drivers are dynamically
826 * added during autoconfiguration (cf. ymf724).
827 * since that would end up calling identify
828 * twice.
829 */
830 if (!isa_running)
831 return;
832
833 DEVICE_IDENTIFY(driver, dev);
834 if (device_get_children(dev, &children, &nchildren))
835 return;
836
837 for (i = 0; i < nchildren; i++) {
838 device_t child = children[i];
839 struct isa_device *idev = DEVTOISA(child);
840 struct resource_list *rl = &idev->id_resources;
841 struct resource_list_entry *rle;
842
843 if (device_get_state(child) != DS_NOTPRESENT)
844 continue;
845 if (!device_is_enabled(child))
846 continue;
847
848 /*
849 * Free resources which we were holding on behalf of
850 * the device.
851 */
852 SLIST_FOREACH(rle, &idev->id_resources, link) {
853 if (rle->res)
854 resource_list_release(rl, dev, child,
855 rle->type,
856 rle->rid,
857 rle->res);
858 }
859
860 if (TAILQ_FIRST(&idev->id_configs))
861 if (!isa_assign_resources(child))
862 continue;
863
864 device_probe_and_attach(child);
865
866 if (TAILQ_FIRST(&idev->id_configs)) {
867 /*
868 * Claim any unallocated resources to keep other
869 * devices from using them.
870 */
871 SLIST_FOREACH(rle, rl, link) {
872 if (!rle->res) {
873 int rid = rle->rid;
874 resource_list_alloc(rl, dev, child,
875 rle->type,
876 &rid,
877 0, ~0, 1,
878 0 /* !RF_ACTIVE */);
879 }
880 }
881 }
882 }
883
884 free(children, M_TEMP);
885}
886
887static int
888isa_set_resource(device_t dev, device_t child, int type, int rid,
889 u_long start, u_long count)
890{
891 struct isa_device* idev = DEVTOISA(child);
892 struct resource_list *rl = &idev->id_resources;
893
894 if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
895 && type != SYS_RES_IRQ && type != SYS_RES_DRQ)
896 return EINVAL;
897 if (rid < 0)
898 return EINVAL;
899 if (type == SYS_RES_IOPORT && rid >= ISA_NPORT)
900 return EINVAL;
901 if (type == SYS_RES_MEMORY && rid >= ISA_NMEM)
902 return EINVAL;
903 if (type == SYS_RES_IRQ && rid >= ISA_NIRQ)
904 return EINVAL;
905 if (type == SYS_RES_DRQ && rid >= ISA_NDRQ)
906 return EINVAL;
907
908 resource_list_add(rl, type, rid, start, start + count - 1, count);
909
910 return 0;
911}
912
913static int
914isa_get_resource(device_t dev, device_t child, int type, int rid,
915 u_long *startp, u_long *countp)
916{
917 struct isa_device* idev = DEVTOISA(child);
918 struct resource_list *rl = &idev->id_resources;
919 struct resource_list_entry *rle;
920
921 rle = resource_list_find(rl, type, rid);
922 if (!rle)
923 return ENOENT;
924
925 if (startp)
926 *startp = rle->start;
927 if (countp)
928 *countp = rle->count;
929
930 return 0;
931}
932
933static void
934isa_delete_resource(device_t dev, device_t child, int type, int rid)
935{
936 struct isa_device* idev = DEVTOISA(child);
937 struct resource_list *rl = &idev->id_resources;
938 resource_list_delete(rl, type, rid);
939}
940
941static int
942isa_add_config(device_t dev, device_t child,
943 int priority, struct isa_config *config)
944{
945 struct isa_device* idev = DEVTOISA(child);
946 struct isa_config_entry *newice, *ice;
947
948 newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT);
949 if (!newice)
950 return ENOMEM;
951
952 newice->ice_priority = priority;
953 newice->ice_config = *config;
954
955 TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
956 if (ice->ice_priority > priority)
957 break;
958 }
959 if (ice)
960 TAILQ_INSERT_BEFORE(ice, newice, ice_link);
961 else
962 TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link);
963
964 return 0;
965}
966
967static void
968isa_set_config_callback(device_t dev, device_t child,
969 isa_config_cb *fn, void *arg)
970{
971 struct isa_device* idev = DEVTOISA(child);
972
973 idev->id_config_cb = fn;
974 idev->id_config_arg = arg;
975}
976
977static int
978isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids)
979{
980 struct isa_device* idev = DEVTOISA(child);
981
982 if (!idev->id_vendorid)
983 return ENOENT;
984
985 while (ids->ip_id) {
986 /*
987 * Really ought to support >1 compat id per device.
988 */
989 if (idev->id_logicalid == ids->ip_id
990 || idev->id_compatid == ids->ip_id) {
991 if (ids->ip_desc)
992 device_set_desc(child, ids->ip_desc);
993 return 0;
994 }
995 ids++;
996 }
997
998 return ENXIO;
999}
1000
1001static device_method_t isa_methods[] = {
1002 /* Device interface */
1003 DEVMETHOD(device_probe, isa_probe),
1004 DEVMETHOD(device_attach, isa_attach),
1005 DEVMETHOD(device_detach, bus_generic_detach),
1006 DEVMETHOD(device_shutdown, bus_generic_shutdown),
1007 DEVMETHOD(device_suspend, bus_generic_suspend),
1008 DEVMETHOD(device_resume, bus_generic_resume),
1009
1010 /* Bus interface */
1011 DEVMETHOD(bus_add_child, isa_add_child),
1012 DEVMETHOD(bus_print_child, isa_print_child),
1013 DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch),
1014 DEVMETHOD(bus_read_ivar, isa_read_ivar),
1015 DEVMETHOD(bus_write_ivar, isa_write_ivar),
1016 DEVMETHOD(bus_child_detached, isa_child_detached),
1017 DEVMETHOD(bus_driver_added, isa_driver_added),
1018 DEVMETHOD(bus_alloc_resource, isa_alloc_resource),
1019 DEVMETHOD(bus_release_resource, isa_release_resource),
1020 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
1021 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
1022 DEVMETHOD(bus_setup_intr, isa_setup_intr),
1023 DEVMETHOD(bus_teardown_intr, isa_teardown_intr),
1024 DEVMETHOD(bus_set_resource, isa_set_resource),
1025 DEVMETHOD(bus_get_resource, isa_get_resource),
1026 DEVMETHOD(bus_delete_resource, isa_delete_resource),
1027
1028 /* ISA interface */
1029 DEVMETHOD(isa_add_config, isa_add_config),
1030 DEVMETHOD(isa_set_config_callback, isa_set_config_callback),
1031 DEVMETHOD(isa_pnp_probe, isa_pnp_probe),
1032
1033 { 0, 0 }
1034};
1035
1036static driver_t isa_driver = {
1037 "isa",
1038 isa_methods,
1039 1, /* no softc */
1040};
1041
1042/*
1043 * ISA can be attached to a PCI-ISA bridge or directly to the nexus.
1044 */
1045DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0);
1046#ifdef __i386__
1047DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0);
1048#endif
1049