sys/bus/isa/isa_common.c

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