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 1042