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