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