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.14 2008/10/18 01:15:33 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 <sys/rman.h> 70 71 #include "isavar.h" 72 #include "isa_common.h" 73 74 static int isa_print_child (device_t, device_t); 75 76 MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device"); 77 78 static devclass_t isa_devclass; 79 static int isa_running; 80 81 /* 82 * At 'probe' time, we add all the devices which we know about to the 83 * bus. The generic attach routine will probe and attach them if they 84 * are alive. 85 */ 86 static int 87 isa_probe(device_t dev) 88 { 89 device_set_desc(dev, "ISA bus"); 90 isa_init(); /* Allow machdep code to initialise */ 91 return 0; 92 } 93 94 extern device_t isa_bus_device; 95 96 static int 97 isa_attach(device_t dev) 98 { 99 /* 100 * Arrange for isa_probe_children(dev) to be called later. XXX 101 */ 102 isa_bus_device = dev; 103 return 0; 104 } 105 106 /* 107 * Find a working set of memory regions for a child using the ranges 108 * in *config and return the regions in *result. Returns non-zero if 109 * a set of ranges was found. 110 */ 111 static int 112 isa_find_memory(device_t child, 113 struct isa_config *config, 114 struct isa_config *result) 115 { 116 int success, i; 117 struct resource *res[ISA_NMEM]; 118 119 /* 120 * First clear out any existing resource definitions. 121 */ 122 for (i = 0; i < ISA_NMEM; i++) { 123 bus_delete_resource(child, SYS_RES_MEMORY, i); 124 res[i] = NULL; 125 } 126 127 success = 1; 128 result->ic_nmem = config->ic_nmem; 129 for (i = 0; i < config->ic_nmem; i++) { 130 u_int32_t start, end, size, align; 131 for (start = config->ic_mem[i].ir_start, 132 end = config->ic_mem[i].ir_end, 133 size = config->ic_mem[i].ir_size, 134 align = config->ic_mem[i].ir_align; 135 start + size - 1 <= end; 136 start += MAX(align, 1)) { 137 bus_set_resource(child, SYS_RES_MEMORY, i, 138 start, size); 139 res[i] = bus_alloc_resource(child, 140 SYS_RES_MEMORY, &i, 141 0, ~0, 1, 0 /* !RF_ACTIVE */); 142 if (res[i]) { 143 result->ic_mem[i].ir_start = start; 144 result->ic_mem[i].ir_end = start + size - 1; 145 result->ic_mem[i].ir_size = size; 146 result->ic_mem[i].ir_align = align; 147 break; 148 } 149 } 150 151 /* 152 * If we didn't find a place for memory range i, then 153 * give up now. 154 */ 155 if (!res[i]) { 156 success = 0; 157 break; 158 } 159 } 160 161 for (i = 0; i < ISA_NMEM; i++) { 162 if (res[i]) 163 bus_release_resource(child, SYS_RES_MEMORY, 164 i, res[i]); 165 } 166 167 return success; 168 } 169 170 /* 171 * Find a working set of port regions for a child using the ranges 172 * in *config and return the regions in *result. Returns non-zero if 173 * a set of ranges was found. 174 */ 175 static int 176 isa_find_port(device_t child, 177 struct isa_config *config, 178 struct isa_config *result) 179 { 180 int success, i; 181 struct resource *res[ISA_NPORT]; 182 183 /* 184 * First clear out any existing resource definitions. 185 */ 186 for (i = 0; i < ISA_NPORT; i++) { 187 bus_delete_resource(child, SYS_RES_IOPORT, i); 188 res[i] = NULL; 189 } 190 191 success = 1; 192 result->ic_nport = config->ic_nport; 193 for (i = 0; i < config->ic_nport; i++) { 194 u_int32_t start, end, size, align; 195 for (start = config->ic_port[i].ir_start, 196 end = config->ic_port[i].ir_end, 197 size = config->ic_port[i].ir_size, 198 align = config->ic_port[i].ir_align; 199 start + size - 1 <= end; 200 start += align) { 201 bus_set_resource(child, SYS_RES_IOPORT, i, 202 start, size); 203 res[i] = bus_alloc_resource(child, 204 SYS_RES_IOPORT, &i, 205 0, ~0, 1, 0 /* !RF_ACTIVE */); 206 if (res[i]) { 207 result->ic_port[i].ir_start = start; 208 result->ic_port[i].ir_end = start + size - 1; 209 result->ic_port[i].ir_size = size; 210 result->ic_port[i].ir_align = align; 211 break; 212 } 213 } 214 215 /* 216 * If we didn't find a place for port range i, then 217 * give up now. 218 */ 219 if (!res[i]) { 220 success = 0; 221 break; 222 } 223 } 224 225 for (i = 0; i < ISA_NPORT; i++) { 226 if (res[i]) 227 bus_release_resource(child, SYS_RES_IOPORT, 228 i, res[i]); 229 } 230 231 return success; 232 } 233 234 /* 235 * Return the index of the first bit in the mask (or -1 if mask is empty. 236 */ 237 static int 238 find_first_bit(u_int32_t mask) 239 { 240 return ffs(mask) - 1; 241 } 242 243 /* 244 * Return the index of the next bit in the mask, or -1 if there are no more. 245 */ 246 static int 247 find_next_bit(u_int32_t mask, int bit) 248 { 249 bit++; 250 while (bit < 32 && !(mask & (1 << bit))) 251 bit++; 252 if (bit != 32) 253 return bit; 254 return -1; 255 } 256 257 /* 258 * Find a working set of irqs for a child using the masks in *config 259 * and return the regions in *result. Returns non-zero if a set of 260 * irqs was found. 261 */ 262 static int 263 isa_find_irq(device_t child, 264 struct isa_config *config, 265 struct isa_config *result) 266 { 267 int success, i; 268 struct resource *res[ISA_NIRQ]; 269 270 /* 271 * First clear out any existing resource definitions. 272 */ 273 for (i = 0; i < ISA_NIRQ; i++) { 274 bus_delete_resource(child, SYS_RES_IRQ, i); 275 res[i] = NULL; 276 } 277 278 success = 1; 279 result->ic_nirq = config->ic_nirq; 280 for (i = 0; i < config->ic_nirq; i++) { 281 u_int32_t mask = config->ic_irqmask[i]; 282 int irq; 283 for (irq = find_first_bit(mask); 284 irq != -1; 285 irq = find_next_bit(mask, irq)) { 286 bus_set_resource(child, SYS_RES_IRQ, i, 287 irq, 1); 288 res[i] = bus_alloc_resource(child, 289 SYS_RES_IRQ, &i, 290 0, ~0, 1, 0 /* !RF_ACTIVE */ ); 291 if (res[i]) { 292 result->ic_irqmask[i] = (1 << irq); 293 break; 294 } 295 } 296 297 /* 298 * If we didn't find a place for irq range i, then 299 * give up now. 300 */ 301 if (!res[i]) { 302 success = 0; 303 break; 304 } 305 } 306 307 for (i = 0; i < ISA_NIRQ; i++) { 308 if (res[i]) 309 bus_release_resource(child, SYS_RES_IRQ, 310 i, res[i]); 311 } 312 313 return success; 314 } 315 316 /* 317 * Find a working set of drqs for a child using the masks in *config 318 * and return the regions in *result. Returns non-zero if a set of 319 * drqs was found. 320 */ 321 static int 322 isa_find_drq(device_t child, 323 struct isa_config *config, 324 struct isa_config *result) 325 { 326 int success, i; 327 struct resource *res[ISA_NDRQ]; 328 329 /* 330 * First clear out any existing resource definitions. 331 */ 332 for (i = 0; i < ISA_NDRQ; i++) { 333 bus_delete_resource(child, SYS_RES_DRQ, i); 334 res[i] = NULL; 335 } 336 337 success = 1; 338 result->ic_ndrq = config->ic_ndrq; 339 for (i = 0; i < config->ic_ndrq; i++) { 340 u_int32_t mask = config->ic_drqmask[i]; 341 int drq; 342 for (drq = find_first_bit(mask); 343 drq != -1; 344 drq = find_next_bit(mask, drq)) { 345 bus_set_resource(child, SYS_RES_DRQ, i, 346 drq, 1); 347 res[i] = bus_alloc_resource(child, 348 SYS_RES_DRQ, &i, 349 0, ~0, 1, 0 /* !RF_ACTIVE */); 350 if (res[i]) { 351 result->ic_drqmask[i] = (1 << drq); 352 break; 353 } 354 } 355 356 /* 357 * If we didn't find a place for drq range i, then 358 * give up now. 359 */ 360 if (!res[i]) { 361 success = 0; 362 break; 363 } 364 } 365 366 for (i = 0; i < ISA_NDRQ; i++) { 367 if (res[i]) 368 bus_release_resource(child, SYS_RES_DRQ, 369 i, res[i]); 370 } 371 372 return success; 373 } 374 375 /* 376 * Attempt to find a working set of resources for a device. Return 377 * non-zero if a working configuration is found. 378 */ 379 static int 380 isa_assign_resources(device_t child) 381 { 382 struct isa_device *idev = DEVTOISA(child); 383 struct isa_config_entry *ice; 384 struct isa_config config; 385 char *reason = "Empty ISA id_configs"; 386 387 bzero(&config, sizeof config); 388 TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 389 reason = "memory"; 390 if (!isa_find_memory(child, &ice->ice_config, &config)) 391 continue; 392 reason = "port"; 393 if (!isa_find_port(child, &ice->ice_config, &config)) 394 continue; 395 reason = "irq"; 396 if (!isa_find_irq(child, &ice->ice_config, &config)) 397 continue; 398 reason = "drq"; 399 if (!isa_find_drq(child, &ice->ice_config, &config)) 400 continue; 401 402 /* 403 * A working configuration was found enable the device 404 * with this configuration. 405 */ 406 reason = "no callback"; 407 if (idev->id_config_cb) { 408 idev->id_config_cb(idev->id_config_arg, 409 &config, 1); 410 return 1; 411 } 412 } 413 414 /* 415 * Disable the device. 416 */ 417 bus_print_child_header(device_get_parent(child), child); 418 kprintf(" can't assign resources (%s)\n", reason); 419 if (bootverbose) 420 isa_print_child(device_get_parent(child), child); 421 bzero(&config, sizeof config); 422 if (idev->id_config_cb) 423 idev->id_config_cb(idev->id_config_arg, &config, 0); 424 device_disable(child); 425 426 return 0; 427 } 428 429 /* 430 * Called after other devices have initialised to probe for isa devices. 431 */ 432 void 433 isa_probe_children(device_t dev) 434 { 435 device_t *children; 436 int nchildren, i; 437 438 /* 439 * Create all the children by calling driver's identify methods. 440 * Since this routine is called long after the ISA bus had been 441 * attached, yet never probed, we have to call a hack function that 442 * temporarily sets the bus back to DS_ALIVE to run the probe. 443 */ 444 bus_generic_probe_hack(dev); 445 446 if (device_get_children(dev, &children, &nchildren)) 447 return; 448 449 /* 450 * First disable all pnp devices so that they don't get 451 * matched by legacy probes. 452 */ 453 if (bootverbose) 454 kprintf("isa_probe_children: disabling PnP devices\n"); 455 for (i = 0; i < nchildren; i++) { 456 device_t child = children[i]; 457 struct isa_device *idev = DEVTOISA(child); 458 struct isa_config config; 459 460 bzero(&config, sizeof config); 461 if (idev->id_config_cb) 462 idev->id_config_cb(idev->id_config_arg, &config, 0); 463 } 464 465 /* 466 * Next probe all non-pnp devices so that they claim their 467 * resources first. 468 */ 469 if (bootverbose) 470 kprintf("isa_probe_children: probing non-PnP devices\n"); 471 for (i = 0; i < nchildren; i++) { 472 device_t child = children[i]; 473 struct isa_device *idev = DEVTOISA(child); 474 475 if (TAILQ_FIRST(&idev->id_configs)) 476 continue; 477 478 device_probe_and_attach(child); 479 } 480 481 /* 482 * Finally assign resource to pnp devices and probe them. 483 */ 484 if (bootverbose) 485 kprintf("isa_probe_children: probing PnP devices\n"); 486 for (i = 0; i < nchildren; i++) { 487 device_t child = children[i]; 488 struct isa_device* idev = DEVTOISA(child); 489 490 if (!TAILQ_FIRST(&idev->id_configs)) 491 continue; 492 493 if (isa_assign_resources(child)) { 494 struct resource_list *rl = &idev->id_resources; 495 struct resource_list_entry *rle; 496 497 device_probe_and_attach(child); 498 499 /* 500 * Claim any unallocated resources to keep other 501 * devices from using them. 502 */ 503 SLIST_FOREACH(rle, rl, link) { 504 if (!rle->res) { 505 int rid = rle->rid; 506 resource_list_alloc(rl, dev, child, 507 rle->type, 508 &rid, 509 0, ~0, 1, 510 0 /* !RF_ACTIVE */); 511 } 512 } 513 } 514 } 515 516 kfree(children, M_TEMP); 517 518 isa_running = 1; 519 } 520 521 /* 522 * Add a new child with default ivars. 523 */ 524 static device_t 525 isa_add_child(device_t bus, device_t parent, int order, const char *name, int unit) 526 { 527 device_t child; 528 struct isa_device *idev; 529 530 idev = kmalloc(sizeof(struct isa_device), M_ISADEV, M_WAITOK | M_ZERO); 531 532 resource_list_init(&idev->id_resources); 533 TAILQ_INIT(&idev->id_configs); 534 535 child = device_add_child_ordered(parent, 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 += kprintf(" %s ", name); 555 else if (printed > 0) 556 retval += kprintf(","); 557 printed++; 558 retval += kprintf(format, rle->start); 559 if (rle->count > 1) { 560 retval += kprintf("-"); 561 retval += kprintf(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 += kprintf(" 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 += kprintf(" 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 kprintf(" 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 kfree(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 = kmalloc(sizeof *ice, M_DEVBUF, M_WAITOK); 950 newice->ice_priority = priority; 951 newice->ice_config = *config; 952 953 TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 954 if (ice->ice_priority > priority) 955 break; 956 } 957 if (ice) 958 TAILQ_INSERT_BEFORE(ice, newice, ice_link); 959 else 960 TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 961 962 return 0; 963 } 964 965 static void 966 isa_set_config_callback(device_t dev, device_t child, 967 isa_config_cb *fn, void *arg) 968 { 969 struct isa_device* idev = DEVTOISA(child); 970 971 idev->id_config_cb = fn; 972 idev->id_config_arg = arg; 973 } 974 975 static int 976 isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 977 { 978 struct isa_device* idev = DEVTOISA(child); 979 980 if (!idev->id_vendorid) 981 return ENOENT; 982 983 while (ids->ip_id) { 984 /* 985 * Really ought to support >1 compat id per device. 986 */ 987 if (idev->id_logicalid == ids->ip_id 988 || idev->id_compatid == ids->ip_id) { 989 if (ids->ip_desc) 990 device_set_desc(child, ids->ip_desc); 991 return 0; 992 } 993 ids++; 994 } 995 996 return ENXIO; 997 } 998 999 static device_method_t isa_methods[] = { 1000 /* Device interface */ 1001 DEVMETHOD(device_probe, isa_probe), 1002 DEVMETHOD(device_attach, isa_attach), 1003 DEVMETHOD(device_detach, bus_generic_detach), 1004 DEVMETHOD(device_shutdown, bus_generic_shutdown), 1005 DEVMETHOD(device_suspend, bus_generic_suspend), 1006 DEVMETHOD(device_resume, bus_generic_resume), 1007 1008 /* Bus interface */ 1009 DEVMETHOD(bus_add_child, isa_add_child), 1010 DEVMETHOD(bus_print_child, isa_print_child), 1011 DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch), 1012 DEVMETHOD(bus_read_ivar, isa_read_ivar), 1013 DEVMETHOD(bus_write_ivar, isa_write_ivar), 1014 DEVMETHOD(bus_child_detached, isa_child_detached), 1015 DEVMETHOD(bus_driver_added, isa_driver_added), 1016 DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 1017 DEVMETHOD(bus_release_resource, isa_release_resource), 1018 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 1019 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 1020 DEVMETHOD(bus_setup_intr, isa_setup_intr), 1021 DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 1022 DEVMETHOD(bus_set_resource, isa_set_resource), 1023 DEVMETHOD(bus_get_resource, isa_get_resource), 1024 DEVMETHOD(bus_delete_resource, isa_delete_resource), 1025 1026 /* ISA interface */ 1027 DEVMETHOD(isa_add_config, isa_add_config), 1028 DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 1029 DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 1030 1031 { 0, 0 } 1032 }; 1033 1034 static driver_t isa_driver = { 1035 "isa", 1036 isa_methods, 1037 1, /* no softc */ 1038 }; 1039 1040 /* 1041 * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 1042 */ 1043 DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 1044 #ifdef __i386__ 1045 DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 1046 #endif 1047 MODULE_VERSION(isa, 1); 1048 1049 /* 1050 * Code common to ISA bridges. 1051 */ 1052 int 1053 isab_attach(device_t dev) 1054 { 1055 device_t child; 1056 1057 child = device_add_child(dev, "isa", 0); 1058 if (child != NULL) 1059 return (bus_generic_attach(dev)); 1060 return (ENXIO); 1061 } 1062