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