]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/isa/isa_common.c
This commit was generated by cvs2svn to compensate for changes in r56639,
[FreeBSD/FreeBSD.git] / sys / 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$
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
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, 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, 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, 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, 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
389         bzero(&config, sizeof config);
390         TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
391                 if (!isa_find_memory(child, &ice->ice_config, &config))
392                         continue;
393                 if (!isa_find_port(child, &ice->ice_config, &config))
394                         continue;
395                 if (!isa_find_irq(child, &ice->ice_config, &config))
396                         continue;
397                 if (!isa_find_drq(child, &ice->ice_config, &config))
398                         continue;
399
400                 /*
401                  * A working configuration was found enable the device 
402                  * with this configuration.
403                  */
404                 if (idev->id_config_cb) {
405                         idev->id_config_cb(idev->id_config_arg,
406                                            &config, 1);
407                         return 1;
408                 }
409         }
410
411         /*
412          * Disable the device.
413          */
414         if (device_get_desc(child))
415             device_printf(child, "<%s> can't assign resources\n",
416                           device_get_desc(child));
417         else
418             device_printf(child, "can't assign resources\n");
419         bzero(&config, sizeof config);
420         if (idev->id_config_cb)
421                 idev->id_config_cb(idev->id_config_arg, &config, 0);
422         device_disable(child);
423
424         return 0;
425 }
426
427 /*
428  * Called after other devices have initialised to probe for isa devices.
429  */
430 void
431 isa_probe_children(device_t dev)
432 {
433         device_t *children;
434         int nchildren, i;
435
436         /*
437          * Create all the children by calling driver's identify methods.
438          */
439         bus_generic_probe(dev);
440
441         if (device_get_children(dev, &children, &nchildren))
442                 return;
443
444         /*
445          * First disable all pnp devices so that they don't get
446          * matched by legacy probes.
447          */
448         if (bootverbose)
449                 printf("isa_probe_children: disabling PnP devices\n");
450         for (i = 0; i < nchildren; i++) {
451                 device_t child = children[i];
452                 struct isa_device *idev = DEVTOISA(child);
453                 struct isa_config config;
454
455                 bzero(&config, sizeof config);
456                 if (idev->id_config_cb)
457                         idev->id_config_cb(idev->id_config_arg, &config, 0);
458         }
459
460         /*
461          * Next probe all non-pnp devices so that they claim their
462          * resources first.
463          */
464         if (bootverbose)
465                 printf("isa_probe_children: probing non-PnP devices\n");
466         for (i = 0; i < nchildren; i++) {
467                 device_t child = children[i];
468                 struct isa_device *idev = DEVTOISA(child);
469
470                 if (TAILQ_FIRST(&idev->id_configs))
471                         continue;
472
473                 device_probe_and_attach(child);
474         }
475
476         /*
477          * Finally assign resource to pnp devices and probe them.
478          */
479         if (bootverbose)
480                 printf("isa_probe_children: probing PnP devices\n");
481         for (i = 0; i < nchildren; i++) {
482                 device_t child = children[i];
483                 struct isa_device* idev = DEVTOISA(child);
484
485                 if (!TAILQ_FIRST(&idev->id_configs))
486                         continue;
487
488                 if (isa_assign_resources(child)) {
489                         struct resource_list *rl = &idev->id_resources;
490                         struct resource_list_entry *rle;
491
492                         device_probe_and_attach(child);
493
494                         /*
495                          * Claim any unallocated resources to keep other
496                          * devices from using them.
497                          */
498                         SLIST_FOREACH(rle, rl, link) {
499                                 if (!rle->res) {
500                                         int rid = rle->rid;
501                                         resource_list_alloc(rl, dev, child,
502                                                             rle->type,
503                                                             &rid,
504                                                             0, ~0, 1,
505                                                             0 /* !RF_ACTIVE */);
506                                 }
507                         }
508                 }
509         }
510
511         free(children, M_TEMP);
512
513         isa_running = 1;
514 }
515
516 /*
517  * Add a new child with default ivars.
518  */
519 static device_t
520 isa_add_child(device_t dev, int order, const char *name, int unit)
521 {
522         device_t child;
523         struct  isa_device *idev;
524
525         idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT);
526         if (!idev)
527                 return 0;
528         bzero(idev, sizeof *idev);
529
530         resource_list_init(&idev->id_resources);
531         TAILQ_INIT(&idev->id_configs);
532
533         child = device_add_child_ordered(dev, order, name, unit);
534         device_set_ivars(child, idev);
535
536         return child;
537 }
538
539 static void
540 isa_print_resources(struct resource_list *rl, const char *name, int type,
541                     int count, const char *format)
542 {
543         struct resource_list_entry *rle;
544         int printed;
545         int i;
546
547         printed = 0;
548         for (i = 0; i < count; i++) {
549                 rle = resource_list_find(rl, type, i);
550                 if (rle) {
551                         if (printed == 0)
552                                 printf(" %s ", name);
553                         else if (printed > 0)
554                                 printf(",");
555                         printed++;
556                         printf(format, rle->start);
557                         if (rle->count > 1) {
558                                 printf("-");
559                                 printf(format, rle->start + rle->count - 1);
560                         }
561                 } else if (i > 3) {
562                         /* check the first few regardless */
563                         break;
564                 }
565         }
566 }
567
568 static int
569 isa_print_child(device_t bus, device_t dev)
570 {
571         struct  isa_device *idev = DEVTOISA(dev);
572         struct resource_list *rl = &idev->id_resources;
573         int retval = 0;
574
575         retval += bus_print_child_header(bus, dev);
576
577         if (SLIST_FIRST(rl) || device_get_flags(dev))
578                 retval += printf(" at");
579         
580         isa_print_resources(rl, "port", SYS_RES_IOPORT, ISA_NPORT, "%#lx");
581         isa_print_resources(rl, "iomem", SYS_RES_MEMORY, ISA_NMEM, "%#lx");
582         isa_print_resources(rl, "irq", SYS_RES_IRQ, ISA_NIRQ, "%ld");
583         isa_print_resources(rl, "drq", SYS_RES_DRQ, ISA_NDRQ, "%ld");
584         if (device_get_flags(dev))
585                 retval += printf(" flags %#x", device_get_flags(dev));
586
587         retval += bus_print_child_footer(bus, dev);
588
589         return (retval);
590 }
591
592 static int
593 isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result)
594 {
595         struct isa_device* idev = DEVTOISA(dev);
596         struct resource_list *rl = &idev->id_resources;
597         struct resource_list_entry *rle;
598
599         switch (index) {
600         case ISA_IVAR_PORT_0:
601                 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
602                 if (rle)
603                         *result = rle->start;
604                 else
605                         *result = -1;
606                 break;
607
608         case ISA_IVAR_PORT_1:
609                 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
610                 if (rle)
611                         *result = rle->start;
612                 else
613                         *result = -1;
614                 break;
615
616         case ISA_IVAR_PORTSIZE_0:
617                 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
618                 if (rle)
619                         *result = rle->count;
620                 else
621                         *result = 0;
622                 break;
623
624         case ISA_IVAR_PORTSIZE_1:
625                 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
626                 if (rle)
627                         *result = rle->count;
628                 else
629                         *result = 0;
630                 break;
631
632         case ISA_IVAR_MADDR_0:
633                 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
634                 if (rle)
635                         *result = rle->start;
636                 else
637                         *result = -1;
638                 break;
639
640         case ISA_IVAR_MADDR_1:
641                 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
642                 if (rle)
643                         *result = rle->start;
644                 else
645                         *result = -1;
646                 break;
647
648         case ISA_IVAR_MSIZE_0:
649                 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
650                 if (rle)
651                         *result = rle->count;
652                 else
653                         *result = 0;
654                 break;
655
656         case ISA_IVAR_MSIZE_1:
657                 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
658                 if (rle)
659                         *result = rle->count;
660                 else
661                         *result = 0;
662                 break;
663
664         case ISA_IVAR_IRQ_0:
665                 rle = resource_list_find(rl, SYS_RES_IRQ, 0);
666                 if (rle)
667                         *result = rle->start;
668                 else
669                         *result = -1;
670                 break;
671
672         case ISA_IVAR_IRQ_1:
673                 rle = resource_list_find(rl, SYS_RES_IRQ, 1);
674                 if (rle)
675                         *result = rle->start;
676                 else
677                         *result = -1;
678                 break;
679
680         case ISA_IVAR_DRQ_0:
681                 rle = resource_list_find(rl, SYS_RES_DRQ, 0);
682                 if (rle)
683                         *result = rle->start;
684                 else
685                         *result = -1;
686                 break;
687
688         case ISA_IVAR_DRQ_1:
689                 rle = resource_list_find(rl, SYS_RES_DRQ, 1);
690                 if (rle)
691                         *result = rle->start;
692                 else
693                         *result = -1;
694                 break;
695
696         case ISA_IVAR_VENDORID:
697                 *result = idev->id_vendorid;
698                 break;
699
700         case ISA_IVAR_SERIAL:
701                 *result = idev->id_serial;
702                 break;
703
704         case ISA_IVAR_LOGICALID:
705                 *result = idev->id_logicalid;
706                 break;
707
708         case ISA_IVAR_COMPATID:
709                 *result = idev->id_compatid;
710                 break;
711
712         default:
713                 return ENOENT;
714         }
715
716         return 0;
717 }
718
719 static int
720 isa_write_ivar(device_t bus, device_t dev,
721                int index, uintptr_t value)
722 {
723         struct isa_device* idev = DEVTOISA(dev);
724
725         switch (index) {
726         case ISA_IVAR_PORT_0:
727         case ISA_IVAR_PORT_1:
728         case ISA_IVAR_PORTSIZE_0:
729         case ISA_IVAR_PORTSIZE_1:
730         case ISA_IVAR_MADDR_0:
731         case ISA_IVAR_MADDR_1:
732         case ISA_IVAR_MSIZE_0:
733         case ISA_IVAR_MSIZE_1:
734         case ISA_IVAR_IRQ_0:
735         case ISA_IVAR_IRQ_1:
736         case ISA_IVAR_DRQ_0:
737         case ISA_IVAR_DRQ_1:
738                 return EINVAL;
739
740         case ISA_IVAR_VENDORID:
741                 idev->id_vendorid = value;
742                 break;
743
744         case ISA_IVAR_SERIAL:
745                 idev->id_serial = value;
746                 break;
747
748         case ISA_IVAR_LOGICALID:
749                 idev->id_logicalid = value;
750                 break;
751
752         case ISA_IVAR_COMPATID:
753                 idev->id_compatid = value;
754                 break;
755
756         default:
757                 return (ENOENT);
758         }
759
760         return (0);
761 }
762
763 /*
764  * Free any resources which the driver missed or which we were holding for
765  * it (see isa_probe_children).
766  */
767 static void
768 isa_child_detached(device_t dev, device_t child)
769 {
770         struct isa_device* idev = DEVTOISA(child);
771         struct resource_list *rl = &idev->id_resources;
772         struct resource_list_entry *rle;
773
774         SLIST_FOREACH(rle, &idev->id_resources, link) {
775                 if (rle->res)
776                         resource_list_release(rl, dev, child,
777                                               rle->type,
778                                               rle->rid,
779                                               rle->res);
780         }
781 }
782
783 static void
784 isa_driver_added(device_t dev, driver_t *driver)
785 {
786         device_t *children;
787         int nchildren, i;
788
789         /*
790          * Don't do anything if drivers are dynamically
791          * added during autoconfiguration (cf. ymf724).
792          * since that would end up calling identify
793          * twice.
794          */
795         if (!isa_running)
796                 return;
797
798         DEVICE_IDENTIFY(driver, dev);
799         if (device_get_children(dev, &children, &nchildren))
800                 return;
801
802         for (i = 0; i < nchildren; i++) {
803                 device_t child = children[i];
804                 struct isa_device *idev = DEVTOISA(child);
805                 struct resource_list *rl = &idev->id_resources;
806                 struct resource_list_entry *rle;
807
808                 if (device_get_state(child) != DS_NOTPRESENT)
809                         continue;
810
811                 if (TAILQ_FIRST(&idev->id_configs))
812                         if (!isa_assign_resources(child))
813                                 continue;
814
815                 device_probe_and_attach(child);
816
817                 if (TAILQ_FIRST(&idev->id_configs)) {
818                         /*
819                          * Claim any unallocated resources to keep other
820                          * devices from using them.
821                          */
822                         SLIST_FOREACH(rle, rl, link) {
823                                 if (!rle->res) {
824                                         int rid = rle->rid;
825                                         resource_list_alloc(rl, dev, child,
826                                                             rle->type,
827                                                             &rid,
828                                                             0, ~0, 1,
829                                                             RF_ACTIVE);
830                                 }
831                         }
832                 }
833         }
834
835         free(children, M_TEMP);
836 }
837
838 static int
839 isa_set_resource(device_t dev, device_t child, int type, int rid,
840                  u_long start, u_long count)
841 {
842         struct isa_device* idev = DEVTOISA(child);
843         struct resource_list *rl = &idev->id_resources;
844
845         if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
846             && type != SYS_RES_IRQ && type != SYS_RES_DRQ)
847                 return EINVAL;
848         if (rid < 0)
849                 return EINVAL;
850         if (type == SYS_RES_IOPORT && rid >= ISA_NPORT)
851                 return EINVAL;
852         if (type == SYS_RES_MEMORY && rid >= ISA_NMEM)
853                 return EINVAL;
854         if (type == SYS_RES_IRQ && rid >= ISA_NIRQ)
855                 return EINVAL;
856         if (type == SYS_RES_DRQ && rid >= ISA_NDRQ)
857                 return EINVAL;
858
859         resource_list_add(rl, type, rid, start, start + count - 1, count);
860
861         return 0;
862 }
863
864 static int
865 isa_get_resource(device_t dev, device_t child, int type, int rid,
866                  u_long *startp, u_long *countp)
867 {
868         struct isa_device* idev = DEVTOISA(child);
869         struct resource_list *rl = &idev->id_resources;
870         struct resource_list_entry *rle;
871
872         rle = resource_list_find(rl, type, rid);
873         if (!rle)
874                 return ENOENT;
875         
876         if (startp)
877                 *startp = rle->start;
878         if (countp)
879                 *countp = rle->count;
880
881         return 0;
882 }
883
884 static void
885 isa_delete_resource(device_t dev, device_t child, int type, int rid)
886 {
887         struct isa_device* idev = DEVTOISA(child);
888         struct resource_list *rl = &idev->id_resources;
889         resource_list_delete(rl, type, rid);
890 }
891
892 static int
893 isa_add_config(device_t dev, device_t child,
894                int priority, struct isa_config *config)
895 {
896         struct isa_device* idev = DEVTOISA(child);
897         struct isa_config_entry *newice, *ice;
898
899         newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT);
900         if (!newice)
901                 return ENOMEM;
902
903         newice->ice_priority = priority;
904         newice->ice_config = *config;
905         
906         TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
907                 if (ice->ice_priority > priority)
908                         break;
909         }
910         if (ice)
911                 TAILQ_INSERT_BEFORE(ice, newice, ice_link);
912         else
913                 TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link);
914
915         return 0;
916 }
917
918 static void
919 isa_set_config_callback(device_t dev, device_t child,
920                         isa_config_cb *fn, void *arg)
921 {
922         struct isa_device* idev = DEVTOISA(child);
923
924         idev->id_config_cb = fn;
925         idev->id_config_arg = arg;
926 }
927
928 static int
929 isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids)
930 {
931         struct isa_device* idev = DEVTOISA(child);
932
933         if (!idev->id_vendorid)
934                 return ENOENT;
935
936         while (ids->ip_id) {
937                 /*
938                  * Really ought to support >1 compat id per device.
939                  */
940                 if (idev->id_logicalid == ids->ip_id
941                     || idev->id_compatid == ids->ip_id) {
942                         if (ids->ip_desc)
943                                 device_set_desc(child, ids->ip_desc);
944                         return 0;
945                 }
946                 ids++;
947         }
948
949         return ENXIO;
950 }
951
952 static device_method_t isa_methods[] = {
953         /* Device interface */
954         DEVMETHOD(device_probe,         isa_probe),
955         DEVMETHOD(device_attach,        isa_attach),
956         DEVMETHOD(device_detach,        bus_generic_detach),
957         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
958         DEVMETHOD(device_suspend,       bus_generic_suspend),
959         DEVMETHOD(device_resume,        bus_generic_resume),
960
961         /* Bus interface */
962         DEVMETHOD(bus_add_child,        isa_add_child),
963         DEVMETHOD(bus_print_child,      isa_print_child),
964         DEVMETHOD(bus_read_ivar,        isa_read_ivar),
965         DEVMETHOD(bus_write_ivar,       isa_write_ivar),
966         DEVMETHOD(bus_child_detached,   isa_child_detached),
967         DEVMETHOD(bus_driver_added,     isa_driver_added),
968         DEVMETHOD(bus_alloc_resource,   isa_alloc_resource),
969         DEVMETHOD(bus_release_resource, isa_release_resource),
970         DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
971         DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
972         DEVMETHOD(bus_setup_intr,       isa_setup_intr),
973         DEVMETHOD(bus_teardown_intr,    isa_teardown_intr),
974         DEVMETHOD(bus_set_resource,     isa_set_resource),
975         DEVMETHOD(bus_get_resource,     isa_get_resource),
976         DEVMETHOD(bus_delete_resource,  isa_delete_resource),
977
978         /* ISA interface */
979         DEVMETHOD(isa_add_config,       isa_add_config),
980         DEVMETHOD(isa_set_config_callback, isa_set_config_callback),
981         DEVMETHOD(isa_pnp_probe,        isa_pnp_probe),
982
983         { 0, 0 }
984 };
985
986 static driver_t isa_driver = {
987         "isa",
988         isa_methods,
989         1,                      /* no softc */
990 };
991
992 /*
993  * ISA can be attached to a PCI-ISA bridge or directly to the nexus.
994  */
995 DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0);
996 #ifdef __i386__
997 DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0);
998 #endif
999
1000 /*
1001  * A fallback driver for reporting un-matched pnp devices.
1002  */
1003
1004 static int
1005 unknown_probe(device_t dev)
1006 {
1007         /*
1008          * Only match pnp devices.
1009          */
1010         if (isa_get_vendorid(dev) != 0)
1011                 return -100;
1012         return ENXIO;
1013 }
1014
1015 static int
1016 unknown_attach(device_t dev)
1017 {
1018         return 0;
1019 }
1020
1021 static int
1022 unknown_detach(device_t dev)
1023 {
1024         return 0;
1025 }
1026
1027 static device_method_t unknown_methods[] = {
1028         /* Device interface */
1029         DEVMETHOD(device_probe,         unknown_probe),
1030         DEVMETHOD(device_attach,        unknown_attach),
1031         DEVMETHOD(device_detach,        unknown_detach),
1032
1033         { 0, 0 }
1034 };
1035
1036 static driver_t unknown_driver = {
1037         "unknown",
1038         unknown_methods,
1039         1,                      /* no softc */
1040 };
1041
1042 static devclass_t unknown_devclass;
1043
1044 DRIVER_MODULE(unknown, isa, unknown_driver, unknown_devclass, 0, 0);