linux/drivers/eisa/eisa-bus.c
<<
>>
Prefs
   1/*
   2 * EISA bus support functions for sysfs.
   3 *
   4 * (C) 2002, 2003 Marc Zyngier <maz@wild-wind.fr.eu.org>
   5 *
   6 * This code is released under the GPL version 2.
   7 */
   8
   9#include <linux/kernel.h>
  10#include <linux/device.h>
  11#include <linux/eisa.h>
  12#include <linux/module.h>
  13#include <linux/moduleparam.h>
  14#include <linux/init.h>
  15#include <linux/slab.h>
  16#include <linux/ioport.h>
  17#include <asm/io.h>
  18
  19#define SLOT_ADDRESS(r,n) (r->bus_base_addr + (0x1000 * n))
  20
  21#define EISA_DEVINFO(i,s) { .id = { .sig = i }, .name = s }
  22
  23struct eisa_device_info {
  24        struct eisa_device_id id;
  25        char name[50];
  26};
  27
  28#ifdef CONFIG_EISA_NAMES
  29static struct eisa_device_info __initdata eisa_table[] = {
  30#include "devlist.h"
  31};
  32#define EISA_INFOS (sizeof (eisa_table) / (sizeof (struct eisa_device_info)))
  33#endif
  34
  35#define EISA_MAX_FORCED_DEV 16
  36
  37static int enable_dev[EISA_MAX_FORCED_DEV];
  38static unsigned int enable_dev_count;
  39static int disable_dev[EISA_MAX_FORCED_DEV];
  40static unsigned int disable_dev_count;
  41
  42static int is_forced_dev(int *forced_tab,
  43                         int forced_count,
  44                         struct eisa_root_device *root,
  45                         struct eisa_device *edev)
  46{
  47        int i, x;
  48
  49        for (i = 0; i < forced_count; i++) {
  50                x = (root->bus_nr << 8) | edev->slot;
  51                if (forced_tab[i] == x)
  52                        return 1;
  53        }
  54
  55        return 0;
  56}
  57
  58static void __init eisa_name_device(struct eisa_device *edev)
  59{
  60#ifdef CONFIG_EISA_NAMES
  61        int i;
  62        for (i = 0; i < EISA_INFOS; i++) {
  63                if (!strcmp(edev->id.sig, eisa_table[i].id.sig)) {
  64                        strlcpy(edev->pretty_name,
  65                                eisa_table[i].name,
  66                                sizeof(edev->pretty_name));
  67                        return;
  68                }
  69        }
  70
  71        /* No name was found */
  72        sprintf(edev->pretty_name, "EISA device %.7s", edev->id.sig);
  73#endif
  74}
  75
  76static char __init *decode_eisa_sig(unsigned long addr)
  77{
  78        static char sig_str[EISA_SIG_LEN];
  79        u8 sig[4];
  80        u16 rev;
  81        int i;
  82
  83        for (i = 0; i < 4; i++) {
  84#ifdef CONFIG_EISA_VLB_PRIMING
  85                /*
  86                 * This ugly stuff is used to wake up VL-bus cards
  87                 * (AHA-284x is the only known example), so we can
  88                 * read the EISA id.
  89                 *
  90                 * Thankfully, this only exists on x86...
  91                 */
  92                outb(0x80 + i, addr);
  93#endif
  94                sig[i] = inb(addr + i);
  95
  96                if (!i && (sig[0] & 0x80))
  97                        return NULL;
  98        }
  99        
 100        sig_str[0] = ((sig[0] >> 2) & 0x1f) + ('A' - 1);
 101        sig_str[1] = (((sig[0] & 3) << 3) | (sig[1] >> 5)) + ('A' - 1);
 102        sig_str[2] = (sig[1] & 0x1f) + ('A' - 1);
 103        rev = (sig[2] << 8) | sig[3];
 104        sprintf(sig_str + 3, "%04X", rev);
 105
 106        return sig_str;
 107}
 108
 109static int eisa_bus_match(struct device *dev, struct device_driver *drv)
 110{
 111        struct eisa_device *edev = to_eisa_device(dev);
 112        struct eisa_driver *edrv = to_eisa_driver(drv);
 113        const struct eisa_device_id *eids = edrv->id_table;
 114
 115        if (!eids)
 116                return 0;
 117
 118        while (strlen(eids->sig)) {
 119                if (!strcmp(eids->sig, edev->id.sig) &&
 120                    edev->state & EISA_CONFIG_ENABLED) {
 121                        edev->id.driver_data = eids->driver_data;
 122                        return 1;
 123                }
 124
 125                eids++;
 126        }
 127
 128        return 0;
 129}
 130
 131static int eisa_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
 132{
 133        struct eisa_device *edev = to_eisa_device(dev);
 134
 135        add_uevent_var(env, "MODALIAS=" EISA_DEVICE_MODALIAS_FMT, edev->id.sig);
 136        return 0;
 137}
 138
 139struct bus_type eisa_bus_type = {
 140        .name  = "eisa",
 141        .match = eisa_bus_match,
 142        .uevent = eisa_bus_uevent,
 143};
 144EXPORT_SYMBOL(eisa_bus_type);
 145
 146int eisa_driver_register(struct eisa_driver *edrv)
 147{
 148        edrv->driver.bus = &eisa_bus_type;
 149        return driver_register(&edrv->driver);
 150}
 151EXPORT_SYMBOL(eisa_driver_register);
 152
 153void eisa_driver_unregister(struct eisa_driver *edrv)
 154{
 155        driver_unregister(&edrv->driver);
 156}
 157EXPORT_SYMBOL(eisa_driver_unregister);
 158
 159static ssize_t eisa_show_sig(struct device *dev, struct device_attribute *attr,
 160                             char *buf)
 161{
 162        struct eisa_device *edev = to_eisa_device(dev);
 163        return sprintf(buf, "%s\n", edev->id.sig);
 164}
 165
 166static DEVICE_ATTR(signature, S_IRUGO, eisa_show_sig, NULL);
 167
 168static ssize_t eisa_show_state(struct device *dev,
 169                               struct device_attribute *attr,
 170                               char *buf)
 171{
 172        struct eisa_device *edev = to_eisa_device(dev);
 173        return sprintf(buf, "%d\n", edev->state & EISA_CONFIG_ENABLED);
 174}
 175
 176static DEVICE_ATTR(enabled, S_IRUGO, eisa_show_state, NULL);
 177
 178static ssize_t eisa_show_modalias(struct device *dev,
 179                                  struct device_attribute *attr,
 180                                  char *buf)
 181{
 182        struct eisa_device *edev = to_eisa_device(dev);
 183        return sprintf(buf, EISA_DEVICE_MODALIAS_FMT "\n", edev->id.sig);
 184}
 185
 186static DEVICE_ATTR(modalias, S_IRUGO, eisa_show_modalias, NULL);
 187
 188static int __init eisa_init_device(struct eisa_root_device *root,
 189                                   struct eisa_device *edev,
 190                                   int slot)
 191{
 192        char *sig;
 193        unsigned long sig_addr;
 194        int i;
 195
 196        sig_addr = SLOT_ADDRESS(root, slot) + EISA_VENDOR_ID_OFFSET;
 197
 198        sig = decode_eisa_sig(sig_addr);
 199        if (!sig)
 200                return -1;      /* No EISA device here */
 201        
 202        memcpy(edev->id.sig, sig, EISA_SIG_LEN);
 203        edev->slot = slot;
 204        edev->state = inb(SLOT_ADDRESS(root, slot) + EISA_CONFIG_OFFSET)
 205                      & EISA_CONFIG_ENABLED;
 206        edev->base_addr = SLOT_ADDRESS(root, slot);
 207        edev->dma_mask = root->dma_mask; /* Default DMA mask */
 208        eisa_name_device(edev);
 209        edev->dev.parent = root->dev;
 210        edev->dev.bus = &eisa_bus_type;
 211        edev->dev.dma_mask = &edev->dma_mask;
 212        edev->dev.coherent_dma_mask = edev->dma_mask;
 213        dev_set_name(&edev->dev, "%02X:%02X", root->bus_nr, slot);
 214
 215        for (i = 0; i < EISA_MAX_RESOURCES; i++) {
 216#ifdef CONFIG_EISA_NAMES
 217                edev->res[i].name = edev->pretty_name;
 218#else
 219                edev->res[i].name = edev->id.sig;
 220#endif
 221        }
 222
 223        if (is_forced_dev(enable_dev, enable_dev_count, root, edev))
 224                edev->state = EISA_CONFIG_ENABLED | EISA_CONFIG_FORCED;
 225        
 226        if (is_forced_dev(disable_dev, disable_dev_count, root, edev))
 227                edev->state = EISA_CONFIG_FORCED;
 228
 229        return 0;
 230}
 231
 232static int __init eisa_register_device(struct eisa_device *edev)
 233{
 234        int rc = device_register(&edev->dev);
 235        if (rc)
 236                return rc;
 237
 238        rc = device_create_file(&edev->dev, &dev_attr_signature);
 239        if (rc)
 240                goto err_devreg;
 241        rc = device_create_file(&edev->dev, &dev_attr_enabled);
 242        if (rc)
 243                goto err_sig;
 244        rc = device_create_file(&edev->dev, &dev_attr_modalias);
 245        if (rc)
 246                goto err_enab;
 247
 248        return 0;
 249
 250err_enab:
 251        device_remove_file(&edev->dev, &dev_attr_enabled);
 252err_sig:
 253        device_remove_file(&edev->dev, &dev_attr_signature);
 254err_devreg:
 255        device_unregister(&edev->dev);
 256        return rc;
 257}
 258
 259static int __init eisa_request_resources(struct eisa_root_device *root,
 260                                         struct eisa_device *edev,
 261                                         int slot)
 262{
 263        int i;
 264
 265        for (i = 0; i < EISA_MAX_RESOURCES; i++) {
 266                /* Don't register resource for slot 0, since this is
 267                 * very likely to fail... :-( Instead, grab the EISA
 268                 * id, now we can display something in /proc/ioports.
 269                 */
 270
 271                /* Only one region for mainboard */
 272                if (!slot && i > 0) {
 273                        edev->res[i].start = edev->res[i].end = 0;
 274                        continue;
 275                }
 276                
 277                if (slot) {
 278                        edev->res[i].start = SLOT_ADDRESS(root, slot)
 279                                             + (i * 0x400);
 280                        edev->res[i].end   = edev->res[i].start + 0xff;
 281                        edev->res[i].flags = IORESOURCE_IO;
 282                } else {
 283                        edev->res[i].start = SLOT_ADDRESS(root, slot)
 284                                             + EISA_VENDOR_ID_OFFSET;
 285                        edev->res[i].end   = edev->res[i].start + 3;
 286                        edev->res[i].flags = IORESOURCE_IO | IORESOURCE_BUSY;
 287                }
 288
 289                dev_printk(KERN_DEBUG, &edev->dev, "%pR\n", &edev->res[i]);
 290                if (request_resource(root->res, &edev->res[i]))
 291                        goto failed;
 292        }
 293
 294        return 0;
 295        
 296 failed:
 297        while (--i >= 0)
 298                release_resource(&edev->res[i]);
 299
 300        return -1;
 301}
 302
 303static void __init eisa_release_resources(struct eisa_device *edev)
 304{
 305        int i;
 306
 307        for (i = 0; i < EISA_MAX_RESOURCES; i++)
 308                if (edev->res[i].start || edev->res[i].end)
 309                        release_resource(&edev->res[i]);
 310}
 311
 312static int __init eisa_probe(struct eisa_root_device *root)
 313{
 314        int i, c;
 315        struct eisa_device *edev;
 316        char *enabled_str;
 317
 318        dev_info(root->dev, "Probing EISA bus %d\n", root->bus_nr);
 319
 320        /* First try to get hold of slot 0. If there is no device
 321         * here, simply fail, unless root->force_probe is set. */
 322        
 323        edev = kzalloc(sizeof(*edev), GFP_KERNEL);
 324        if (!edev) {
 325                dev_err(root->dev, "EISA: Couldn't allocate mainboard slot\n");
 326                return -ENOMEM;
 327        }
 328                
 329        if (eisa_init_device(root, edev, 0)) {
 330                kfree(edev);
 331                if (!root->force_probe)
 332                        return -ENODEV;
 333                goto force_probe;
 334        }
 335
 336        if (eisa_request_resources(root, edev, 0)) {
 337                dev_warn(root->dev,
 338                         "EISA: Cannot allocate resource for mainboard\n");
 339                kfree(edev);
 340                if (!root->force_probe)
 341                        return -EBUSY;
 342                goto force_probe;
 343        }
 344
 345        dev_info(&edev->dev, "EISA: Mainboard %s detected\n", edev->id.sig);
 346
 347        if (eisa_register_device(edev)) {
 348                dev_err(&edev->dev, "EISA: Failed to register %s\n",
 349                        edev->id.sig);
 350                eisa_release_resources(edev);
 351                kfree(edev);
 352        }
 353        
 354 force_probe:
 355        
 356        for (c = 0, i = 1; i <= root->slots; i++) {
 357                edev = kzalloc(sizeof(*edev), GFP_KERNEL);
 358                if (!edev) {
 359                        dev_err(root->dev, "EISA: Out of memory for slot %d\n",
 360                                i);
 361                        continue;
 362                }
 363
 364                if (eisa_init_device(root, edev, i)) {
 365                        kfree(edev);
 366                        continue;
 367                }
 368
 369                if (eisa_request_resources(root, edev, i)) {
 370                        dev_warn(root->dev,
 371                                 "Cannot allocate resource for EISA slot %d\n",
 372                                 i);
 373                        kfree(edev);
 374                        continue;
 375                }
 376
 377                if (edev->state == (EISA_CONFIG_ENABLED | EISA_CONFIG_FORCED))
 378                        enabled_str = " (forced enabled)";
 379                else if (edev->state == EISA_CONFIG_FORCED)
 380                        enabled_str = " (forced disabled)";
 381                else if (edev->state == 0)
 382                        enabled_str = " (disabled)";
 383                else
 384                        enabled_str = "";
 385
 386                dev_info(&edev->dev, "EISA: slot %d: %s detected%s\n", i,
 387                         edev->id.sig, enabled_str);
 388
 389                c++;
 390
 391                if (eisa_register_device(edev)) {
 392                        dev_err(&edev->dev, "EISA: Failed to register %s\n",
 393                                edev->id.sig);
 394                        eisa_release_resources(edev);
 395                        kfree(edev);
 396                }
 397        }
 398
 399        dev_info(root->dev, "EISA: Detected %d card%s\n", c, c == 1 ? "" : "s");
 400        return 0;
 401}
 402
 403static struct resource eisa_root_res = {
 404        .name  = "EISA root resource",
 405        .start = 0,
 406        .end   = 0xffffffff,
 407        .flags = IORESOURCE_IO,
 408};
 409
 410static int eisa_bus_count;
 411
 412int __init eisa_root_register(struct eisa_root_device *root)
 413{
 414        int err;
 415
 416        /* Use our own resources to check if this bus base address has
 417         * been already registered. This prevents the virtual root
 418         * device from registering after the real one has, for
 419         * example... */
 420        
 421        root->eisa_root_res.name  = eisa_root_res.name;
 422        root->eisa_root_res.start = root->res->start;
 423        root->eisa_root_res.end   = root->res->end;
 424        root->eisa_root_res.flags = IORESOURCE_BUSY;
 425
 426        err = request_resource(&eisa_root_res, &root->eisa_root_res);
 427        if (err)
 428                return err;
 429        
 430        root->bus_nr = eisa_bus_count++;
 431
 432        err = eisa_probe(root);
 433        if (err)
 434                release_resource(&root->eisa_root_res);
 435
 436        return err;
 437}
 438
 439static int __init eisa_init(void)
 440{
 441        int r;
 442        
 443        r = bus_register(&eisa_bus_type);
 444        if (r)
 445                return r;
 446
 447        printk(KERN_INFO "EISA bus registered\n");
 448        return 0;
 449}
 450
 451module_param_array(enable_dev, int, &enable_dev_count, 0444);
 452module_param_array(disable_dev, int, &disable_dev_count, 0444);
 453
 454postcore_initcall(eisa_init);
 455
 456int EISA_bus;           /* for legacy drivers */
 457EXPORT_SYMBOL(EISA_bus);
 458
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.