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