The Design and Implementation of the FreeBSD Operating System, Second Edition
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 

    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 ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.