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