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_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         { 0, 0 }
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 }