f2a349bb1cf629806d1cf002888ae38777d10ef4
[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  */
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 <sys/rman.h>
69 #include <sys/machintr.h>
70
71 #include "isavar.h"
72 #include "isa_common.h"
73
74 static int      isa_print_child         (device_t, device_t);
75
76 MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device");
77
78 static devclass_t isa_devclass;
79 static 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  */
86 static int
87 isa_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
94 extern device_t isa_bus_device;
95
96 static int
97 isa_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  */
111 static int
112 isa_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;
136                      start += MAX(align, 1)) {
137                         bus_set_resource(child, SYS_RES_MEMORY, i,
138                                          start, size, -1);
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  */
175 static int
176 isa_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, -1);
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  */
237 static int
238 find_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  */
246 static int
247 find_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  */
262 static int
263 isa_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, machintr_legacy_intr_cpuid(irq));
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  */
321 static int
322 isa_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, -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  */
379 static int
380 isa_assign_resources(device_t child)
381 {
382         struct isa_device *idev = DEVTOISA(child);
383         struct isa_config_entry *ice;
384         struct isa_config config;
385         char *reason = "Empty ISA id_configs";
386
387         bzero(&config, sizeof config);
388         TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
389                 reason = "memory";
390                 if (!isa_find_memory(child, &ice->ice_config, &config))
391                         continue;
392                 reason = "port";
393                 if (!isa_find_port(child, &ice->ice_config, &config))
394                         continue;
395                 reason = "irq";
396                 if (!isa_find_irq(child, &ice->ice_config, &config))
397                         continue;
398                 reason = "drq";
399                 if (!isa_find_drq(child, &ice->ice_config, &config))
400                         continue;
401
402                 /*
403                  * A working configuration was found enable the device 
404                  * with this configuration.
405                  */
406                 reason = "no callback";
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);
418         kprintf(" can't assign resources (%s)\n", reason);
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  */
432 void
433 isa_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.
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.
443          */
444         bus_generic_probe_hack(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                 kprintf("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                 kprintf("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                 kprintf("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, &rid, 0, ~0, 1,
508                                             0 /* !RF_ACTIVE */, -1);
509                                 }
510                         }
511                 }
512         }
513
514         kfree(children, M_TEMP);
515
516         isa_running = 1;
517 }
518
519 /*
520  * Add a new child with default ivars.
521  */
522 static device_t
523 isa_add_child(device_t bus, device_t parent, int order, const char *name, int unit)
524 {
525         device_t child;
526         struct  isa_device *idev;
527
528         idev = kmalloc(sizeof(struct isa_device), M_ISADEV, M_WAITOK | M_ZERO);
529
530         resource_list_init(&idev->id_resources);
531         TAILQ_INIT(&idev->id_configs);
532
533         child = device_add_child_ordered(parent, order, name, unit);
534         device_set_ivars(child, idev);
535
536         return child;
537 }
538
539 static int
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, retval = 0;
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                                 retval += kprintf(" %s ", name);
553                         else if (printed > 0)
554                                 retval += kprintf(",");
555                         printed++;
556                         retval += kprintf(format, rle->start);
557                         if (rle->count > 1) {
558                                 retval += kprintf("-");
559                                 retval += kprintf(format,
560                                                  rle->start + rle->count - 1);
561                         }
562                 } else if (i > 3) {
563                         /* check the first few regardless */
564                         break;
565                 }
566         }
567         return retval;
568 }
569
570 static int
571 isa_print_all_resources(device_t dev)
572 {
573         struct  isa_device *idev = DEVTOISA(dev);
574         struct resource_list *rl = &idev->id_resources;
575         int retval = 0;
576
577         if (SLIST_FIRST(rl) || device_get_flags(dev))
578                 retval += kprintf(" at");
579         
580         retval += isa_print_resources(rl, "port", SYS_RES_IOPORT,
581                                       ISA_NPORT, "%#lx");
582         retval += isa_print_resources(rl, "iomem", SYS_RES_MEMORY,
583                                       ISA_NMEM, "%#lx");
584         retval += isa_print_resources(rl, "irq", SYS_RES_IRQ,
585                                       ISA_NIRQ, "%ld");
586         retval += isa_print_resources(rl, "drq", SYS_RES_DRQ,
587                                       ISA_NDRQ, "%ld");
588         if (device_get_flags(dev))
589                 retval += kprintf(" flags %#x", device_get_flags(dev));
590
591         return retval;
592 }
593
594 static int
595 isa_print_child(device_t bus, device_t dev)
596 {
597         int retval = 0;
598
599         retval += bus_print_child_header(bus, dev);
600         retval += isa_print_all_resources(dev);
601         retval += bus_print_child_footer(bus, dev);
602
603         return (retval);
604 }
605
606 static void
607 isa_probe_nomatch(device_t dev, device_t child)
608 {
609         if (bootverbose) {
610                 bus_print_child_header(dev, child);
611                 kprintf(" failed to probe");
612                 isa_print_all_resources(child);
613                 bus_print_child_footer(dev, child);
614         }
615                                       
616         return;
617 }
618
619 static int
620 isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result)
621 {
622         struct isa_device* idev = DEVTOISA(dev);
623         struct resource_list *rl = &idev->id_resources;
624         struct resource_list_entry *rle;
625
626         switch (index) {
627         case ISA_IVAR_PORT_0:
628                 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
629                 if (rle)
630                         *result = rle->start;
631                 else
632                         *result = -1;
633                 break;
634
635         case ISA_IVAR_PORT_1:
636                 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
637                 if (rle)
638                         *result = rle->start;
639                 else
640                         *result = -1;
641                 break;
642
643         case ISA_IVAR_PORTSIZE_0:
644                 rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
645                 if (rle)
646                         *result = rle->count;
647                 else
648                         *result = 0;
649                 break;
650
651         case ISA_IVAR_PORTSIZE_1:
652                 rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
653                 if (rle)
654                         *result = rle->count;
655                 else
656                         *result = 0;
657                 break;
658
659         case ISA_IVAR_MADDR_0:
660                 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
661                 if (rle)
662                         *result = rle->start;
663                 else
664                         *result = -1;
665                 break;
666
667         case ISA_IVAR_MADDR_1:
668                 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
669                 if (rle)
670                         *result = rle->start;
671                 else
672                         *result = -1;
673                 break;
674
675         case ISA_IVAR_MSIZE_0:
676                 rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
677                 if (rle)
678                         *result = rle->count;
679                 else
680                         *result = 0;
681                 break;
682
683         case ISA_IVAR_MSIZE_1:
684                 rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
685                 if (rle)
686                         *result = rle->count;
687                 else
688                         *result = 0;
689                 break;
690
691         case ISA_IVAR_IRQ_0:
692                 rle = resource_list_find(rl, SYS_RES_IRQ, 0);
693                 if (rle)
694                         *result = rle->start;
695                 else
696                         *result = -1;
697                 break;
698
699         case ISA_IVAR_IRQ_1:
700                 rle = resource_list_find(rl, SYS_RES_IRQ, 1);
701                 if (rle)
702                         *result = rle->start;
703                 else
704                         *result = -1;
705                 break;
706
707         case ISA_IVAR_DRQ_0:
708                 rle = resource_list_find(rl, SYS_RES_DRQ, 0);
709                 if (rle)
710                         *result = rle->start;
711                 else
712                         *result = -1;
713                 break;
714
715         case ISA_IVAR_DRQ_1:
716                 rle = resource_list_find(rl, SYS_RES_DRQ, 1);
717                 if (rle)
718                         *result = rle->start;
719                 else
720                         *result = -1;
721                 break;
722
723         case ISA_IVAR_VENDORID:
724                 *result = idev->id_vendorid;
725                 break;
726
727         case ISA_IVAR_SERIAL:
728                 *result = idev->id_serial;
729                 break;
730
731         case ISA_IVAR_LOGICALID:
732                 *result = idev->id_logicalid;
733                 break;
734
735         case ISA_IVAR_COMPATID:
736                 *result = idev->id_compatid;
737                 break;
738
739         default:
740                 return ENOENT;
741         }
742
743         return 0;
744 }
745
746 static int
747 isa_write_ivar(device_t bus, device_t dev,
748                int index, uintptr_t value)
749 {
750         struct isa_device* idev = DEVTOISA(dev);
751
752         switch (index) {
753         case ISA_IVAR_PORT_0:
754         case ISA_IVAR_PORT_1:
755         case ISA_IVAR_PORTSIZE_0:
756         case ISA_IVAR_PORTSIZE_1:
757         case ISA_IVAR_MADDR_0:
758         case ISA_IVAR_MADDR_1:
759         case ISA_IVAR_MSIZE_0:
760         case ISA_IVAR_MSIZE_1:
761         case ISA_IVAR_IRQ_0:
762         case ISA_IVAR_IRQ_1:
763         case ISA_IVAR_DRQ_0:
764         case ISA_IVAR_DRQ_1:
765                 return EINVAL;
766
767         case ISA_IVAR_VENDORID:
768                 idev->id_vendorid = value;
769                 break;
770
771         case ISA_IVAR_SERIAL:
772                 idev->id_serial = value;
773                 break;
774
775         case ISA_IVAR_LOGICALID:
776                 idev->id_logicalid = value;
777                 break;
778
779         case ISA_IVAR_COMPATID:
780                 idev->id_compatid = value;
781                 break;
782
783         default:
784                 return (ENOENT);
785         }
786
787         return (0);
788 }
789
790 /*
791  * Free any resources which the driver missed or which we were holding for
792  * it (see isa_probe_children).
793  */
794 static void
795 isa_child_detached(device_t dev, device_t child)
796 {
797         struct isa_device* idev = DEVTOISA(child);
798         struct resource_list *rl = &idev->id_resources;
799         struct resource_list_entry *rle;
800
801         if (TAILQ_FIRST(&idev->id_configs)) {
802                 /*
803                  * Claim any unallocated resources to keep other
804                  * devices from using them.
805                  */
806                 SLIST_FOREACH(rle, rl, link) {
807                         if (!rle->res) {
808                                 int rid = rle->rid;
809                                 resource_list_alloc(rl, dev, child,
810                                     rle->type, &rid, 0, ~0, 1,
811                                     0 /* !RF_ACTIVE */, -1);
812                         }
813                 }
814         }
815 }
816
817 static void
818 isa_driver_added(device_t dev, driver_t *driver)
819 {
820         device_t *children;
821         int nchildren, i;
822
823         /*
824          * Don't do anything if drivers are dynamically
825          * added during autoconfiguration (cf. ymf724).
826          * since that would end up calling identify
827          * twice.
828          */
829         if (!isa_running)
830                 return;
831
832         DEVICE_IDENTIFY(driver, dev);
833         if (device_get_children(dev, &children, &nchildren))
834                 return;
835
836         for (i = 0; i < nchildren; i++) {
837                 device_t child = children[i];
838                 struct isa_device *idev = DEVTOISA(child);
839                 struct resource_list *rl = &idev->id_resources;
840                 struct resource_list_entry *rle;
841
842                 if (device_get_state(child) != DS_NOTPRESENT)
843                         continue;
844                 if (!device_is_enabled(child))
845                         continue;
846
847                 /*
848                  * Free resources which we were holding on behalf of
849                  * the device.
850                  */
851                 SLIST_FOREACH(rle, &idev->id_resources, link) {
852                         if (rle->res)
853                                 resource_list_release(rl, dev, child,
854                                                       rle->type,
855                                                       rle->rid,
856                                                       rle->res);
857                 }
858
859                 if (TAILQ_FIRST(&idev->id_configs))
860                         if (!isa_assign_resources(child))
861                                 continue;
862
863                 device_probe_and_attach(child);
864
865                 if (TAILQ_FIRST(&idev->id_configs)) {
866                         /*
867                          * Claim any unallocated resources to keep other
868                          * devices from using them.
869                          */
870                         SLIST_FOREACH(rle, rl, link) {
871                                 if (!rle->res) {
872                                         int rid = rle->rid;
873                                         resource_list_alloc(rl, dev, child,
874                                             rle->type, &rid, 0, ~0, 1,
875                                             0 /* !RF_ACTIVE */, -1);
876                                 }
877                         }
878                 }
879         }
880
881         kfree(children, M_TEMP);
882 }
883
884 static int
885 isa_set_resource(device_t dev, device_t child, int type, int rid,
886                  u_long start, u_long count, int cpuid)
887 {
888         struct isa_device* idev = DEVTOISA(child);
889         struct resource_list *rl = &idev->id_resources;
890
891         if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
892             && type != SYS_RES_IRQ && type != SYS_RES_DRQ)
893                 return EINVAL;
894         if (rid < 0)
895                 return EINVAL;
896         if (type == SYS_RES_IOPORT && rid >= ISA_NPORT)
897                 return EINVAL;
898         if (type == SYS_RES_MEMORY && rid >= ISA_NMEM)
899                 return EINVAL;
900         if (type == SYS_RES_IRQ && rid >= ISA_NIRQ)
901                 return EINVAL;
902         if (type == SYS_RES_DRQ && rid >= ISA_NDRQ)
903                 return EINVAL;
904
905         resource_list_add(rl, type, rid, start, start + count - 1, count,
906             cpuid);
907
908         return 0;
909 }
910
911 static int
912 isa_get_resource(device_t dev, device_t child, int type, int rid,
913                  u_long *startp, u_long *countp)
914 {
915         struct isa_device* idev = DEVTOISA(child);
916         struct resource_list *rl = &idev->id_resources;
917         struct resource_list_entry *rle;
918
919         rle = resource_list_find(rl, type, rid);
920         if (!rle)
921                 return ENOENT;
922         
923         if (startp)
924                 *startp = rle->start;
925         if (countp)
926                 *countp = rle->count;
927
928         return 0;
929 }
930
931 static void
932 isa_delete_resource(device_t dev, device_t child, int type, int rid)
933 {
934         struct isa_device* idev = DEVTOISA(child);
935         struct resource_list *rl = &idev->id_resources;
936         resource_list_delete(rl, type, rid);
937 }
938
939 static int
940 isa_add_config(device_t dev, device_t child,
941                int priority, struct isa_config *config)
942 {
943         struct isa_device* idev = DEVTOISA(child);
944         struct isa_config_entry *newice, *ice;
945
946         newice = kmalloc(sizeof *ice, M_DEVBUF, M_WAITOK);
947         newice->ice_priority = priority;
948         newice->ice_config = *config;
949         
950         TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
951                 if (ice->ice_priority > priority)
952                         break;
953         }
954         if (ice)
955                 TAILQ_INSERT_BEFORE(ice, newice, ice_link);
956         else
957                 TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link);
958
959         return 0;
960 }
961
962 static void
963 isa_set_config_callback(device_t dev, device_t child,
964                         isa_config_cb *fn, void *arg)
965 {
966         struct isa_device* idev = DEVTOISA(child);
967
968         idev->id_config_cb = fn;
969         idev->id_config_arg = arg;
970 }
971
972 static int
973 isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids)
974 {
975         struct isa_device* idev = DEVTOISA(child);
976
977         if (!idev->id_vendorid)
978                 return ENOENT;
979
980         while (ids->ip_id) {
981                 /*
982                  * Really ought to support >1 compat id per device.
983                  */
984                 if (idev->id_logicalid == ids->ip_id
985                     || idev->id_compatid == ids->ip_id) {
986                         if (ids->ip_desc)
987                                 device_set_desc(child, ids->ip_desc);
988                         return 0;
989                 }
990                 ids++;
991         }
992
993         return ENXIO;
994 }
995
996 static device_method_t isa_methods[] = {
997         /* Device interface */
998         DEVMETHOD(device_probe,         isa_probe),
999         DEVMETHOD(device_attach,        isa_attach),
1000         DEVMETHOD(device_detach,        bus_generic_detach),
1001         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
1002         DEVMETHOD(device_suspend,       bus_generic_suspend),
1003         DEVMETHOD(device_resume,        bus_generic_resume),
1004
1005         /* Bus interface */
1006         DEVMETHOD(bus_add_child,        isa_add_child),
1007         DEVMETHOD(bus_print_child,      isa_print_child),
1008         DEVMETHOD(bus_probe_nomatch,    isa_probe_nomatch),     
1009         DEVMETHOD(bus_read_ivar,        isa_read_ivar),
1010         DEVMETHOD(bus_write_ivar,       isa_write_ivar),
1011         DEVMETHOD(bus_child_detached,   isa_child_detached),
1012         DEVMETHOD(bus_driver_added,     isa_driver_added),
1013         DEVMETHOD(bus_alloc_resource,   isa_alloc_resource),
1014         DEVMETHOD(bus_release_resource, isa_release_resource),
1015         DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
1016         DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
1017         DEVMETHOD(bus_setup_intr,       isa_setup_intr),
1018         DEVMETHOD(bus_teardown_intr,    isa_teardown_intr),
1019         DEVMETHOD(bus_set_resource,     isa_set_resource),
1020         DEVMETHOD(bus_get_resource,     isa_get_resource),
1021         DEVMETHOD(bus_delete_resource,  isa_delete_resource),
1022
1023         /* ISA interface */
1024         DEVMETHOD(isa_add_config,       isa_add_config),
1025         DEVMETHOD(isa_set_config_callback, isa_set_config_callback),
1026         DEVMETHOD(isa_pnp_probe,        isa_pnp_probe),
1027
1028         DEVMETHOD_END
1029 };
1030
1031 static driver_t isa_driver = {
1032         "isa",
1033         isa_methods,
1034         1,                      /* no softc */
1035 };
1036
1037 /*
1038  * ISA can be attached to a PCI-ISA bridge or directly to the nexus.
1039  */
1040 DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, NULL, NULL);
1041 #ifdef __i386__
1042 DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, NULL, NULL);
1043 #endif
1044 MODULE_VERSION(isa, 1);
1045
1046 /*
1047  * Code common to ISA bridges.
1048  */
1049 int
1050 isab_attach(device_t dev)
1051 {
1052         device_t child;
1053
1054         child = device_add_child(dev, "isa", 0);
1055         if (child != NULL)
1056                 return (bus_generic_attach(dev));
1057         return (ENXIO);
1058 }