Merge from vendor branch GCC:
[dragonfly.git] / sys / bus / isa / isa_common.c
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  * $DragonFly: src/sys/bus/isa/isa_common.c,v 1.7 2005/08/04 15:38:58 drhodus Exp $
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>
69 #include <machine/bus.h>
70 #include <sys/rman.h>
71
72 #include <machine/resource.h>
73
74 #include "isavar.h"
75 #include "isa_common.h"
76
77 static int      isa_print_child         (device_t, device_t);
78
79 MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device");
80
81 static devclass_t isa_devclass;
82 static int isa_running;
83
84 /*
85  * At 'probe' time, we add all the devices which we know about to the
86  * bus.  The generic attach routine will probe and attach them if they
87  * are alive.
88  */
89 static int
90 isa_probe(device_t dev)
91 {
92         device_set_desc(dev, "ISA bus");
93         isa_init();             /* Allow machdep code to initialise */
94         return 0;
95 }
96
97 extern device_t isa_bus_device;
98
99 static int
100 isa_attach(device_t dev)
101 {
102         /*
103          * Arrange for isa_probe_children(dev) to be called later. XXX
104          */
105         isa_bus_device = dev;
106         return 0;
107 }
108
109 /*
110  * Find a working set of memory regions for a child using the ranges
111  * in *config  and return the regions in *result. Returns non-zero if
112  * a set of ranges was found.
113  */
114 static int
115 isa_find_memory(device_t child,
116                 struct isa_config *config,
117                 struct isa_config *result)
118 {
119         int success, i;
120         struct resource *res[ISA_NMEM];
121
122         /*
123          * First clear out any existing resource definitions.
124          */
125         for (i = 0; i < ISA_NMEM; i++) {
126                 bus_delete_resource(child, SYS_RES_MEMORY, i);
127                 res[i] = NULL;
128         }
129
130         success = 1;
131         result->ic_nmem = config->ic_nmem;
132         for (i = 0; i < config->ic_nmem; i++) {
133                 u_int32_t start, end, size, align;
134                 for (start = config->ic_mem[i].ir_start,
135                              end = config->ic_mem[i].ir_end,
136                              size = config->ic_mem[i].ir_size,
137                              align = config->ic_mem[i].ir_align;
138                      start + size - 1 <= end;
139                      start += align) {
140                         bus_set_resource(child, SYS_RES_MEMORY, i,
141                                          start, size);
142                         res[i] = bus_alloc_resource(child,
143                                                     SYS_RES_MEMORY, &i,
144                                                     0, ~0, 1, 0 /* !RF_ACTIVE */);
145                         if (res[i]) {
146                                 result->ic_mem[i].ir_start = start;
147                                 result->ic_mem[i].ir_end = start + size - 1;
148                                 result->ic_mem[i].ir_size = size;
149                                 result->ic_mem[i].ir_align = align;
150                                 break;
151                         }
152                 }
153
154                 /*
155                  * If we didn't find a place for memory range i, then 
156                  * give up now.
157                  */
158                 if (!res[i]) {
159                         success = 0;
160                         break;
161                 }
162         }
163
164         for (i = 0; i < ISA_NMEM; i++) {
165                 if (res[i])
166                         bus_release_resource(child, SYS_RES_MEMORY,
167                                              i, res[i]);
168         }
169
170         return success;
171 }
172
173 /*
174  * Find a working set of port regions for a child using the ranges
175  * in *config  and return the regions in *result. Returns non-zero if
176  * a set of ranges was found.
177  */
178 static int
179 isa_find_port(device_t child,
180               struct isa_config *config,
181               struct isa_config *result)
182 {
183         int success, i;
184         struct resource *res[ISA_NPORT];
185
186         /*
187          * First clear out any existing resource definitions.
188          */
189         for (i = 0; i < ISA_NPORT; i++) {
190                 bus_delete_resource(child, SYS_RES_IOPORT, i);
191                 res[i] = NULL;
192         }
193
194         success = 1;
195         result->ic_nport = config->ic_nport;
196         for (i = 0; i < config->ic_nport; i++) {
197                 u_int32_t start, end, size, align;
198                 for (start = config->ic_port[i].ir_start,
199                              end = config->ic_port[i].ir_end,
200                              size = config->ic_port[i].ir_size,
201                              align = config->ic_port[i].ir_align;
202                      start + size - 1 <= end;
203                      start += align) {
204                         bus_set_resource(child, SYS_RES_IOPORT, i,
205                                          start, size);
206                         res[i] = bus_alloc_resource(child,
207                                                     SYS_RES_IOPORT, &i,
208                                                     0, ~0, 1, 0 /* !RF_ACTIVE */);
209                         if (res[i]) {
210                                 result->ic_port[i].ir_start = start;
211                                 result->ic_port[i].ir_end = start + size - 1;
212                                 result->ic_port[i].ir_size = size;
213                                 result->ic_port[i].ir_align = align;
214                                 break;
215                         }
216                 }
217
218                 /*
219                  * If we didn't find a place for port range i, then 
220                  * give up now.
221                  */
222                 if (!res[i]) {
223                         success = 0;
224                         break;
225                 }
226         }
227
228         for (i = 0; i < ISA_NPORT; i++) {
229                 if (res[i])
230                         bus_release_resource(child, SYS_RES_IOPORT,
231                                              i, res[i]);
232         }
233
234         return success;
235 }
236
237 /*
238  * Return the index of the first bit in the mask (or -1 if mask is empty.
239  */
240 static int
241 find_first_bit(u_int32_t mask)
242 {
243         return ffs(mask) - 1;
244 }
245
246 /*
247  * Return the index of the next bit in the mask, or -1 if there are no more.
248  */
249 static int
250 find_next_bit(u_int32_t mask, int bit)
251 {
252         bit++;
253         while (bit < 32 && !(mask & (1 << bit)))
254                 bit++;
255         if (bit != 32)
256                 return bit;
257         return -1;
258 }
259
260 /*
261  * Find a working set of irqs for a child using the masks in *config
262  * and return the regions in *result. Returns non-zero if a set of
263  * irqs was found.
264  */
265 static int
266 isa_find_irq(device_t child,
267              struct isa_config *config,
268              struct isa_config *result)
269 {
270         int success, i;
271         struct resource *res[ISA_NIRQ];
272
273         /*
274          * First clear out any existing resource definitions.
275          */
276         for (i = 0; i < ISA_NIRQ; i++) {
277                 bus_delete_resource(child, SYS_RES_IRQ, i);
278                 res[i] = NULL;
279         }
280
281         success = 1;
282         result->ic_nirq = config->ic_nirq;
283         for (i = 0; i < config->ic_nirq; i++) {
284                 u_int32_t mask = config->ic_irqmask[i];
285                 int irq;
286                 for (irq = find_first_bit(mask);
287                      irq != -1;
288                      irq = find_next_bit(mask, irq)) {
289                         bus_set_resource(child, SYS_RES_IRQ, i,
290                                          irq, 1);
291                         res[i] = bus_alloc_resource(child,
292                                                     SYS_RES_IRQ, &i,
293                                                     0, ~0, 1, 0 /* !RF_ACTIVE */ );
294                         if (res[i]) {
295                                 result->ic_irqmask[i] = (1 << irq);
296                                 break;
297                         }
298                 }
299
300                 /*
301                  * If we didn't find a place for irq range i, then 
302                  * give up now.
303                  */
304                 if (!res[i]) {
305                         success = 0;
306                         break;
307                 }
308         }
309
310         for (i = 0; i < ISA_NIRQ; i++) {
311                 if (res[i])
312                         bus_release_resource(child, SYS_RES_IRQ,
313                                              i, res[i]);
314         }
315
316         return success;
317 }
318
319 /*
320  * Find a working set of drqs for a child using the masks in *config
321  * and return the regions in *result. Returns non-zero if a set of
322  * drqs was found.
323  */
324 static int
325 isa_find_drq(device_t child,
326              struct isa_config *config,
327              struct isa_config *result)
328 {
329         int success, i;
330         struct resource *res[ISA_NDRQ];
331
332         /*
333          * First clear out any existing resource definitions.
334          */
335         for (i = 0; i < ISA_NDRQ; i++) {
336                 bus_delete_resource(child, SYS_RES_DRQ, i);
337                 res[i] = NULL;
338         }
339
340         success = 1;
341         result->ic_ndrq = config->ic_ndrq;
342         for (i = 0; i < config->ic_ndrq; i++) {
343                 u_int32_t mask = config->ic_drqmask[i];
344                 int drq;
345                 for (drq = find_first_bit(mask);
346                      drq != -1;
347                      drq = find_next_bit(mask, drq)) {
348                         bus_set_resource(child, SYS_RES_DRQ, i,
349                                          drq, 1);
350                         res[i] = bus_alloc_resource(child,
351                                                     SYS_RES_DRQ, &i,
352                                                     0, ~0, 1, 0 /* !RF_ACTIVE */);
353                         if (res[i]) {
354                                 result->ic_drqmask[i] = (1 << drq);
355                                 break;
356                         }
357                 }
358
359                 /*
360                  * If we didn't find a place for drq range i, then 
361                  * give up now.
362                  */
363                 if (!res[i]) {
364                         success = 0;
365                         break;
366                 }
367         }
368
369         for (i = 0; i < ISA_NDRQ; i++) {
370                 if (res[i])
371                         bus_release_resource(child, SYS_RES_DRQ,
372                                              i, res[i]);
373         }
374
375         return success;
376 }
377
378 /*
379  * Attempt to find a working set of resources for a device. Return
380  * non-zero if a working configuration is found.
381  */
382 static int
383 isa_assign_resources(device_t child)
384 {
385         struct isa_device *idev = DEVTOISA(child);
386         struct isa_config_entry *ice;
387         struct isa_config config;
388         char *reason = "Empty ISA id_configs";
389
390         bzero(&config, sizeof config);
391         TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
392                 reason = "memory";
393                 if (!isa_find_memory(child, &ice->ice_config, &config))
394                         continue;
395                 reason = "port";
396                 if (!isa_find_port(child, &ice->ice_config, &config))
397                         continue;
398                 reason = "irq";
399                 if (!isa_find_irq(child, &ice->ice_config, &config))
400                         continue;
401                 reason = "drq";
402                 if (!isa_find_drq(child, &ice->ice_config, &config))
403                         continue;
404
405                 /*
406                  * A working configuration was found enable the device 
407                  * with this configuration.
408                  */
409                 reason = "no callback";
410                 if (idev->id_config_cb) {
411                         idev->id_config_cb(idev->id_config_arg,
412                                            &config, 1);
413                         return 1;
414                 }
415         }
416
417         /*
418          * Disable the device.
419          */
420         bus_print_child_header(device_get_parent(child), child);
421         printf(" can't assign resources (%s)\n", reason);
422         if (bootverbose)
423             isa_print_child(device_get_parent(child), child);
424         bzero(&config, sizeof config);
425         if (idev->id_config_cb)
426                 idev->id_config_cb(idev->id_config_arg, &config, 0);
427         device_disable(child);
428
429         return 0;
430 }
431
432 /*
433  * Called after other devices have initialised to probe for isa devices.
434  */
435 void
436 isa_probe_children(device_t dev)
437 {
438         device_t *children;
439         int nchildren, i;
440
441         /*
442          * Create all the children by calling driver's identify methods.
443          */
444         bus_generic_probe(dev);
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)
454                 printf("isa_probe_children: disabling PnP devices\n");
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)
470                 printf("isa_probe_children: probing non-PnP devices\n");
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)
485                 printf("isa_probe_children: probing PnP devices\n");
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
516         free(children, M_TEMP);
517
518         isa_running = 1;
519 }
520
521 /*
522  * Add a new child with default ivars.
523  */
524 static device_t
525 isa_add_child(device_t dev, int order, const char *name, int unit)
526 {
527         device_t child;
528         struct  isa_device *idev;
529
530         idev = malloc(sizeof(struct isa_device), M_ISADEV, M_WAITOK | M_ZERO);
531
532         resource_list_init(&idev->id_resources);
533         TAILQ_INIT(&idev->id_configs);
534
535         child = device_add_child_ordered(dev, order, name, unit);
536         device_set_ivars(child, idev);
537
538         return child;
539 }
540
541 static int
542 isa_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;
547         int i, retval = 0;;
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)
554                                 retval += printf(" %s ", name);
555                         else if (printed > 0)
556                                 retval += printf(",");
557                         printed++;
558                         retval += printf(format, rle->start);
559                         if (rle->count > 1) {
560                                 retval += printf("-");
561                                 retval += printf(format,
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
572 static int
573 isa_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))
580                 retval += printf(" at");
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))
591                 retval += printf(" flags %#x", device_get_flags(dev));
592
593         return retval;
594 }
595
596 static int
597 isa_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
608 static void
609 isa_probe_nomatch(device_t dev, device_t child)
610 {
611         if (bootverbose) {
612                 bus_print_child_header(dev, child);
613                 printf(" failed to probe");
614                 isa_print_all_resources(child);
615                 bus_print_child_footer(dev, child);
616         }
617                                       
618         return;
619 }
620
621 static int
622 isa_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
748 static int
749 isa_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  */
796 static void
797 isa_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
819 static void
820 isa_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
885         free(children, M_TEMP);
886 }
887
888 static int
889 isa_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
914 static int
915 isa_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
934 static void
935 isa_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
942 static int
943 isa_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
949         newice = malloc(sizeof *ice, M_DEVBUF, M_WAITOK);
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
965 static void
966 isa_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
975 static int
976 isa_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
999 static 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
1034 static 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  */
1043 DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0);
1044 #ifdef __i386__
1045 DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0);
1046 #endif
1047