Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]
FreeBSD/Linux Kernel Cross Reference
sys/isa/isa_common.c
Version:
- FREEBSD - FREEBSD-13-STABLE - FREEBSD-13-0 - FREEBSD-12-STABLE - FREEBSD-12-0 - FREEBSD-11-STABLE - FREEBSD-11-0 - FREEBSD-10-STABLE - FREEBSD-10-0 - FREEBSD-9-STABLE - FREEBSD-9-0 - FREEBSD-8-STABLE - FREEBSD-8-0 - FREEBSD-7-STABLE - FREEBSD-7-0 - FREEBSD-6-STABLE - FREEBSD-6-0 - FREEBSD-5-STABLE - FREEBSD-5-0 - FREEBSD-4-STABLE - FREEBSD-3-STABLE - FREEBSD22 - l41 - OPENBSD - linux-2.6 - MK84 - PLAN9 - xnu-8792
SearchContext: - none - 3 - 10
SearchContext: - none - 3 - 10
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 /* 27 * Modifications for Intel architecture by Garrett A. Wollman. 28 * Copyright 1998 Massachusetts Institute of Technology 29 * 30 * Permission to use, copy, modify, and distribute this software and 31 * its documentation for any purpose and without fee is hereby 32 * granted, provided that both the above copyright notice and this 33 * permission notice appear in all copies, that both the above 34 * copyright notice and this permission notice appear in all 35 * supporting documentation, and that the name of M.I.T. not be used 36 * in advertising or publicity pertaining to distribution of the 37 * software without specific, written prior permission. M.I.T. makes 38 * no representations about the suitability of this software for any 39 * purpose. It is provided "as is" without express or implied 40 * warranty. 41 * 42 * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS 43 * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, 44 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 45 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT 46 * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 47 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 48 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 49 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 50 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 51 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 52 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 53 * SUCH DAMAGE. 54 */ 55 56 /* 57 * Parts of the ISA bus implementation common to all architectures. 58 */ 59 60 #include <sys/cdefs.h> 61 __FBSDID("$FreeBSD$"); 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 79 static int isa_print_child(device_t bus, device_t dev); 80 81 static MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device"); 82 83 static 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 */ 90 static int 91 isa_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 98 extern device_t isa_bus_device; 99 100 static int 101 isa_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 */ 115 static int 116 isa_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 */ 189 static int 190 isa_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 */ 261 static int 262 find_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 */ 270 static int 271 find_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 */ 286 static int 287 isa_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 */ 351 static int 352 isa_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 */ 415 static int 416 isa_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 * Return non-zero if the device has a single configuration, that is, 472 * a fixed set of resoruces. 473 */ 474 static int 475 isa_has_single_config(device_t dev) 476 { 477 struct isa_device *idev = DEVTOISA(dev); 478 struct isa_config_entry *ice; 479 uint32_t mask; 480 int i; 481 482 ice = TAILQ_FIRST(&idev->id_configs); 483 if (TAILQ_NEXT(ice, ice_link)) 484 return (0); 485 486 for (i = 0; i < ice->ice_config.ic_nmem; ++i) { 487 if (ice->ice_config.ic_mem[i].ir_size == 0) 488 continue; 489 if (ice->ice_config.ic_mem[i].ir_end != 490 ice->ice_config.ic_mem[i].ir_start + 491 ice->ice_config.ic_mem[i].ir_size - 1) 492 return (0); 493 } 494 for (i = 0; i < ice->ice_config.ic_nport; ++i) { 495 if (ice->ice_config.ic_port[i].ir_size == 0) 496 continue; 497 if (ice->ice_config.ic_port[i].ir_end != 498 ice->ice_config.ic_port[i].ir_start + 499 ice->ice_config.ic_port[i].ir_size - 1) 500 return (0); 501 } 502 for (i = 0; i < ice->ice_config.ic_nirq; ++i) { 503 mask = ice->ice_config.ic_irqmask[i]; 504 if (mask == 0) 505 continue; 506 if (find_next_bit(mask, find_first_bit(mask)) != -1) 507 return (0); 508 } 509 for (i = 0; i < ice->ice_config.ic_ndrq; ++i) { 510 mask = ice->ice_config.ic_drqmask[i]; 511 if (mask == 0) 512 continue; 513 if (find_next_bit(mask, find_first_bit(mask)) != -1) 514 return (0); 515 } 516 return (1); 517 } 518 519 /* 520 * Called after other devices have initialised to probe for isa devices. 521 */ 522 void 523 isa_probe_children(device_t dev) 524 { 525 device_t *children; 526 struct isa_config *cfg; 527 int nchildren, i; 528 529 /* 530 * Create all the children by calling driver's identify methods. 531 */ 532 bus_generic_probe(dev); 533 534 if (device_get_children(dev, &children, &nchildren)) 535 return; 536 537 /* 538 * First disable all pnp devices so that they don't get 539 * matched by legacy probes. 540 */ 541 if (bootverbose) 542 printf("isa_probe_children: disabling PnP devices\n"); 543 544 cfg = malloc(sizeof(*cfg), M_TEMP, M_NOWAIT|M_ZERO); 545 if (cfg == NULL) { 546 free(children, M_TEMP); 547 return; 548 } 549 550 for (i = 0; i < nchildren; i++) { 551 device_t child = children[i]; 552 struct isa_device *idev = DEVTOISA(child); 553 554 bzero(cfg, sizeof(*cfg)); 555 if (idev->id_config_cb) 556 idev->id_config_cb(idev->id_config_arg, cfg, 0); 557 } 558 559 free(cfg, M_TEMP); 560 561 /* 562 * Next probe all non-pnp devices so that they claim their 563 * resources first. 564 */ 565 if (bootverbose) 566 printf("isa_probe_children: probing non-PnP devices\n"); 567 for (i = 0; i < nchildren; i++) { 568 device_t child = children[i]; 569 struct isa_device *idev = DEVTOISA(child); 570 571 if (TAILQ_FIRST(&idev->id_configs)) 572 continue; 573 574 device_probe_and_attach(child); 575 } 576 577 /* 578 * Finally assign resource to pnp devices and probe them. 579 */ 580 if (bootverbose) 581 printf("isa_probe_children: probing PnP devices\n"); 582 for (i = 0; i < nchildren; i++) { 583 device_t child = children[i]; 584 struct isa_device* idev = DEVTOISA(child); 585 586 if (!TAILQ_FIRST(&idev->id_configs)) 587 continue; 588 589 if (isa_assign_resources(child)) { 590 struct resource_list *rl = &idev->id_resources; 591 struct resource_list_entry *rle; 592 593 device_probe_and_attach(child); 594 595 /* 596 * Claim any unallocated resources to keep other 597 * devices from using them. 598 */ 599 STAILQ_FOREACH(rle, rl, link) { 600 if (!rle->res) { 601 int rid = rle->rid; 602 resource_list_alloc(rl, dev, child, 603 rle->type, 604 &rid, 605 0, ~0, 1, 0); 606 } 607 } 608 } 609 } 610 611 free(children, M_TEMP); 612 613 isa_running = 1; 614 } 615 616 /* 617 * Add a new child with default ivars. 618 */ 619 static device_t 620 isa_add_child(device_t dev, int order, const char *name, int unit) 621 { 622 device_t child; 623 struct isa_device *idev; 624 625 child = device_add_child_ordered(dev, order, name, unit); 626 if (child == NULL) 627 return (child); 628 629 idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT | M_ZERO); 630 if (!idev) 631 return (0); 632 633 resource_list_init(&idev->id_resources); 634 TAILQ_INIT(&idev->id_configs); 635 636 device_set_ivars(child, idev); 637 638 return (child); 639 } 640 641 static int 642 isa_print_all_resources(device_t dev) 643 { 644 struct isa_device *idev = DEVTOISA(dev); 645 struct resource_list *rl = &idev->id_resources; 646 int retval = 0; 647 648 if (STAILQ_FIRST(rl) || device_get_flags(dev)) 649 retval += printf(" at"); 650 651 retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx"); 652 retval += resource_list_print_type(rl, "iomem", SYS_RES_MEMORY, "%#lx"); 653 retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld"); 654 retval += resource_list_print_type(rl, "drq", SYS_RES_DRQ, "%ld"); 655 if (device_get_flags(dev)) 656 retval += printf(" flags %#x", device_get_flags(dev)); 657 #ifdef ISAPNP 658 if (idev->id_vendorid) 659 retval += printf(" pnpid %s", pnp_eisaformat(idev->id_vendorid)); 660 #endif 661 662 return (retval); 663 } 664 665 static int 666 isa_print_child(device_t bus, device_t dev) 667 { 668 int retval = 0; 669 670 retval += bus_print_child_header(bus, dev); 671 retval += isa_print_all_resources(dev); 672 retval += bus_print_child_footer(bus, dev); 673 674 return (retval); 675 } 676 677 static void 678 isa_probe_nomatch(device_t dev, device_t child) 679 { 680 if (bootverbose) { 681 bus_print_child_header(dev, child); 682 printf(" failed to probe"); 683 isa_print_all_resources(child); 684 bus_print_child_footer(dev, child); 685 } 686 687 return; 688 } 689 690 static int 691 isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 692 { 693 struct isa_device* idev = DEVTOISA(dev); 694 struct resource_list *rl = &idev->id_resources; 695 struct resource_list_entry *rle; 696 697 switch (index) { 698 case ISA_IVAR_PORT_0: 699 rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 700 if (rle) 701 *result = rle->start; 702 else 703 *result = -1; 704 break; 705 706 case ISA_IVAR_PORT_1: 707 rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 708 if (rle) 709 *result = rle->start; 710 else 711 *result = -1; 712 break; 713 714 case ISA_IVAR_PORTSIZE_0: 715 rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 716 if (rle) 717 *result = rle->count; 718 else 719 *result = 0; 720 break; 721 722 case ISA_IVAR_PORTSIZE_1: 723 rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 724 if (rle) 725 *result = rle->count; 726 else 727 *result = 0; 728 break; 729 730 case ISA_IVAR_MADDR_0: 731 rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 732 if (rle) 733 *result = rle->start; 734 else 735 *result = -1; 736 break; 737 738 case ISA_IVAR_MADDR_1: 739 rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 740 if (rle) 741 *result = rle->start; 742 else 743 *result = -1; 744 break; 745 746 case ISA_IVAR_MEMSIZE_0: 747 rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 748 if (rle) 749 *result = rle->count; 750 else 751 *result = 0; 752 break; 753 754 case ISA_IVAR_MEMSIZE_1: 755 rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 756 if (rle) 757 *result = rle->count; 758 else 759 *result = 0; 760 break; 761 762 case ISA_IVAR_IRQ_0: 763 rle = resource_list_find(rl, SYS_RES_IRQ, 0); 764 if (rle) 765 *result = rle->start; 766 else 767 *result = -1; 768 break; 769 770 case ISA_IVAR_IRQ_1: 771 rle = resource_list_find(rl, SYS_RES_IRQ, 1); 772 if (rle) 773 *result = rle->start; 774 else 775 *result = -1; 776 break; 777 778 case ISA_IVAR_DRQ_0: 779 rle = resource_list_find(rl, SYS_RES_DRQ, 0); 780 if (rle) 781 *result = rle->start; 782 else 783 *result = -1; 784 break; 785 786 case ISA_IVAR_DRQ_1: 787 rle = resource_list_find(rl, SYS_RES_DRQ, 1); 788 if (rle) 789 *result = rle->start; 790 else 791 *result = -1; 792 break; 793 794 case ISA_IVAR_VENDORID: 795 *result = idev->id_vendorid; 796 break; 797 798 case ISA_IVAR_SERIAL: 799 *result = idev->id_serial; 800 break; 801 802 case ISA_IVAR_LOGICALID: 803 *result = idev->id_logicalid; 804 break; 805 806 case ISA_IVAR_COMPATID: 807 *result = idev->id_compatid; 808 break; 809 810 case ISA_IVAR_CONFIGATTR: 811 *result = idev->id_config_attr; 812 break; 813 814 default: 815 return (ENOENT); 816 } 817 818 return (0); 819 } 820 821 static int 822 isa_write_ivar(device_t bus, device_t dev, int index, uintptr_t value) 823 { 824 struct isa_device* idev = DEVTOISA(dev); 825 826 switch (index) { 827 case ISA_IVAR_PORT_0: 828 case ISA_IVAR_PORT_1: 829 case ISA_IVAR_PORTSIZE_0: 830 case ISA_IVAR_PORTSIZE_1: 831 case ISA_IVAR_MADDR_0: 832 case ISA_IVAR_MADDR_1: 833 case ISA_IVAR_MEMSIZE_0: 834 case ISA_IVAR_MEMSIZE_1: 835 case ISA_IVAR_IRQ_0: 836 case ISA_IVAR_IRQ_1: 837 case ISA_IVAR_DRQ_0: 838 case ISA_IVAR_DRQ_1: 839 return (EINVAL); 840 841 case ISA_IVAR_VENDORID: 842 idev->id_vendorid = value; 843 break; 844 845 case ISA_IVAR_SERIAL: 846 idev->id_serial = value; 847 break; 848 849 case ISA_IVAR_LOGICALID: 850 idev->id_logicalid = value; 851 break; 852 853 case ISA_IVAR_COMPATID: 854 idev->id_compatid = value; 855 break; 856 857 case ISA_IVAR_CONFIGATTR: 858 idev->id_config_attr = value; 859 break; 860 861 default: 862 return (ENOENT); 863 } 864 865 return (0); 866 } 867 868 /* 869 * Free any resources which the driver missed or which we were holding for 870 * it (see isa_probe_children). 871 */ 872 static void 873 isa_child_detached(device_t dev, device_t child) 874 { 875 struct isa_device* idev = DEVTOISA(child); 876 struct resource_list *rl = &idev->id_resources; 877 struct resource_list_entry *rle; 878 879 if (TAILQ_FIRST(&idev->id_configs)) { 880 /* 881 * Claim any unallocated resources to keep other 882 * devices from using them. 883 */ 884 STAILQ_FOREACH(rle, rl, link) { 885 if (!rle->res) { 886 int rid = rle->rid; 887 resource_list_alloc(rl, dev, child, 888 rle->type, 889 &rid, 0, ~0, 1, 0); 890 } 891 } 892 } 893 } 894 895 static void 896 isa_driver_added(device_t dev, driver_t *driver) 897 { 898 device_t *children; 899 int nchildren, i; 900 901 /* 902 * Don't do anything if drivers are dynamically 903 * added during autoconfiguration (cf. ymf724). 904 * since that would end up calling identify 905 * twice. 906 */ 907 if (!isa_running) 908 return; 909 910 DEVICE_IDENTIFY(driver, dev); 911 if (device_get_children(dev, &children, &nchildren)) 912 return; 913 914 for (i = 0; i < nchildren; i++) { 915 device_t child = children[i]; 916 struct isa_device *idev = DEVTOISA(child); 917 struct resource_list *rl = &idev->id_resources; 918 struct resource_list_entry *rle; 919 920 if (device_get_state(child) != DS_NOTPRESENT) 921 continue; 922 if (!device_is_enabled(child)) 923 continue; 924 925 /* 926 * Free resources which we were holding on behalf of 927 * the device. 928 */ 929 STAILQ_FOREACH(rle, &idev->id_resources, link) { 930 if (rle->res) 931 resource_list_release(rl, dev, child, 932 rle->type, 933 rle->rid, 934 rle->res); 935 } 936 937 if (TAILQ_FIRST(&idev->id_configs)) 938 if (!isa_assign_resources(child)) 939 continue; 940 941 device_probe_and_attach(child); 942 943 if (TAILQ_FIRST(&idev->id_configs)) { 944 /* 945 * Claim any unallocated resources to keep other 946 * devices from using them. 947 */ 948 STAILQ_FOREACH(rle, rl, link) { 949 if (!rle->res) { 950 int rid = rle->rid; 951 resource_list_alloc(rl, dev, child, 952 rle->type, 953 &rid, 0, ~0, 1, 0); 954 } 955 } 956 } 957 } 958 959 free(children, M_TEMP); 960 } 961 962 static int 963 isa_set_resource(device_t dev, device_t child, int type, int rid, 964 u_long start, u_long count) 965 { 966 struct isa_device* idev = DEVTOISA(child); 967 struct resource_list *rl = &idev->id_resources; 968 969 if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 970 && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 971 return (EINVAL); 972 if (rid < 0) 973 return (EINVAL); 974 if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 975 return (EINVAL); 976 if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 977 return (EINVAL); 978 if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 979 return (EINVAL); 980 if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 981 return (EINVAL); 982 983 resource_list_add(rl, type, rid, start, start + count - 1, count); 984 985 return (0); 986 } 987 988 static struct resource_list * 989 isa_get_resource_list (device_t dev, device_t child) 990 { 991 struct isa_device* idev = DEVTOISA(child); 992 struct resource_list *rl = &idev->id_resources; 993 994 if (!rl) 995 return (NULL); 996 997 return (rl); 998 } 999 1000 static int 1001 isa_add_config(device_t dev, device_t child, int priority, 1002 struct isa_config *config) 1003 { 1004 struct isa_device* idev = DEVTOISA(child); 1005 struct isa_config_entry *newice, *ice; 1006 1007 newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 1008 if (!newice) 1009 return (ENOMEM); 1010 1011 newice->ice_priority = priority; 1012 newice->ice_config = *config; 1013 1014 TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 1015 if (ice->ice_priority > priority) 1016 break; 1017 } 1018 if (ice) 1019 TAILQ_INSERT_BEFORE(ice, newice, ice_link); 1020 else 1021 TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 1022 1023 if (isa_has_single_config(child)) 1024 idev->id_config_attr &= ~ISACFGATTR_MULTI; 1025 else 1026 idev->id_config_attr |= ISACFGATTR_MULTI; 1027 1028 return (0); 1029 } 1030 1031 static void 1032 isa_set_config_callback(device_t dev, device_t child, isa_config_cb *fn, 1033 void *arg) 1034 { 1035 struct isa_device* idev = DEVTOISA(child); 1036 1037 idev->id_config_cb = fn; 1038 idev->id_config_arg = arg; 1039 } 1040 1041 static int 1042 isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 1043 { 1044 struct isa_device* idev = DEVTOISA(child); 1045 1046 if (!idev->id_vendorid) 1047 return (ENOENT); 1048 1049 while (ids && ids->ip_id) { 1050 /* 1051 * Really ought to support >1 compat id per device. 1052 */ 1053 if (idev->id_logicalid == ids->ip_id 1054 || idev->id_compatid == ids->ip_id) { 1055 if (ids->ip_desc) 1056 device_set_desc(child, ids->ip_desc); 1057 return (0); 1058 } 1059 ids++; 1060 } 1061 1062 return (ENXIO); 1063 } 1064 1065 static int 1066 isa_child_pnpinfo_str(device_t bus, device_t child, char *buf, 1067 size_t buflen) 1068 { 1069 #ifdef ISAPNP 1070 struct isa_device *idev = DEVTOISA(child); 1071 1072 if (idev->id_vendorid) 1073 snprintf(buf, buflen, "pnpid=%s", 1074 pnp_eisaformat(idev->id_vendorid)); 1075 #endif 1076 return (0); 1077 } 1078 1079 static int 1080 isa_child_location_str(device_t bus, device_t child, char *buf, 1081 size_t buflen) 1082 { 1083 /* Nothing here yet */ 1084 *buf = '\0'; 1085 return (0); 1086 } 1087 1088 static device_method_t isa_methods[] = { 1089 /* Device interface */ 1090 DEVMETHOD(device_probe, isa_probe), 1091 DEVMETHOD(device_attach, isa_attach), 1092 DEVMETHOD(device_detach, bus_generic_detach), 1093 DEVMETHOD(device_shutdown, bus_generic_shutdown), 1094 DEVMETHOD(device_suspend, bus_generic_suspend), 1095 DEVMETHOD(device_resume, bus_generic_resume), 1096 1097 /* Bus interface */ 1098 DEVMETHOD(bus_add_child, isa_add_child), 1099 DEVMETHOD(bus_print_child, isa_print_child), 1100 DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch), 1101 DEVMETHOD(bus_read_ivar, isa_read_ivar), 1102 DEVMETHOD(bus_write_ivar, isa_write_ivar), 1103 DEVMETHOD(bus_child_detached, isa_child_detached), 1104 DEVMETHOD(bus_driver_added, isa_driver_added), 1105 DEVMETHOD(bus_setup_intr, isa_setup_intr), 1106 DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 1107 1108 DEVMETHOD(bus_get_resource_list,isa_get_resource_list), 1109 DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 1110 DEVMETHOD(bus_release_resource, isa_release_resource), 1111 DEVMETHOD(bus_set_resource, isa_set_resource), 1112 DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 1113 DEVMETHOD(bus_delete_resource, bus_generic_rl_delete_resource), 1114 DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 1115 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 1116 DEVMETHOD(bus_child_pnpinfo_str, isa_child_pnpinfo_str), 1117 DEVMETHOD(bus_child_location_str, isa_child_location_str), 1118 1119 /* ISA interface */ 1120 DEVMETHOD(isa_add_config, isa_add_config), 1121 DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 1122 DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 1123 1124 { 0, 0 } 1125 }; 1126 1127 driver_t isa_driver = { 1128 "isa", 1129 isa_methods, 1130 1, /* no softc */ 1131 }; 1132 1133 devclass_t isa_devclass; 1134 1135 /* 1136 * ISA can be attached to a PCI-ISA bridge, or other locations on some 1137 * platforms. 1138 */ 1139 DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 1140 DRIVER_MODULE(isa, eisab, isa_driver, isa_devclass, 0, 0); 1141 MODULE_VERSION(isa, 1); 1142 1143 /* 1144 * Code common to ISA bridges. 1145 */ 1146 1147 devclass_t isab_devclass; 1148 1149 int 1150 isab_attach(device_t dev) 1151 { 1152 device_t child; 1153 1154 child = device_add_child(dev, "isa", 0); 1155 if (child != NULL) 1156 return (bus_generic_attach(dev)); 1157 return (ENXIO); 1158 }
Cache object: a7771249e91069bb6246461e67eaffb9
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]