drivers/eisa/eisa-bus.c

   1 /*
   2  * EISA bus support functions for sysfs.
   3  *
   4  * (C) 2002 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/init.h>
  14 #include <linux/slab.h>
  15 #include <linux/ioport.h>
  16 #include <asm/io.h>
  17
  18 #define EISA_DEVINFO(i,s) { .id = { .sig = i }, .name = s }
  19
  20 struct eisa_device_info {
  21         struct eisa_device_id id;
  22         char name[DEVICE_NAME_SIZE];
  23 };
  24
  25 struct eisa_device_info __initdata eisa_table[] = {
  26 #ifdef CONFIG_EISA_NAMES
  27 #include "devlist.h"
  28 #endif
  29 };
  30
  31 #define EISA_INFOS (sizeof (eisa_table) / (sizeof (struct eisa_device_info)))
  32
  33 static void __init eisa_name_device (struct eisa_device *edev)
  34 {
  35         int i;
  36
  37         for (i = 0; i < EISA_INFOS; i++) {
  38                 if (!strcmp (edev->id.sig, eisa_table[i].id.sig)) {
  39                         strncpy (edev->dev.name,
  40                                  eisa_table[i].name,
  41                                  DEVICE_NAME_SIZE - 1);
  42                         return;
  43                 }
  44         }
  45
  46         /* No name was found */
  47         sprintf (edev->dev.name, "EISA device %.7s", edev->id.sig);
  48 }
  49
  50 static char __init *decode_eisa_sig(unsigned long addr)
  51 {
  52         static char sig_str[EISA_SIG_LEN];
  53         u8 sig[4];
  54         u16 rev;
  55         int i;
  56
  57         sig[0] = inb (addr);
  58
  59         if (sig[0] & 0x80)
  60                 return NULL;
  61
  62         for (i = 1; i < 4; i++)
  63                 sig[i] = inb (addr + i);
  64
  65         sig_str[0] = ((sig[0] >> 2) & 0x1f) + ('A' - 1);
  66         sig_str[1] = (((sig[0] & 3) << 3) | (sig[1] >> 5)) + ('A' - 1);
  67         sig_str[2] = (sig[1] & 0x1f) + ('A' - 1);
  68         rev = (sig[2] << 8) | sig[3];
  69         sprintf(sig_str + 3, "%04X", rev);
  70
  71         return sig_str;
  72 }
  73
  74 static int eisa_bus_match (struct device *dev, struct device_driver *drv)
  75 {
  76         struct eisa_device *edev = to_eisa_device (dev);
  77         struct eisa_driver *edrv = to_eisa_driver (drv);
  78         const struct eisa_device_id *eids = edrv->id_table;
  79
  80         if (!eids)
  81                 return 0;
  82
  83         while (strlen (eids->sig)) {
  84                 if (!strcmp (eids->sig, edev->id.sig))
  85                         return 1;
  86
  87                 eids++;
  88         }
  89
  90         return 0;
  91 }
  92
  93 struct bus_type eisa_bus_type = {
  94         .name  = "eisa",
  95         .match = eisa_bus_match,
  96 };
  97
  98 /* The default EISA device parent (virtual root device). */
  99 static struct device eisa_bus_root = {
 100        .name           = "EISA Bridge",
 101        .bus_id         = "eisa",
 102 };
 103
 104 int eisa_driver_register (struct eisa_driver *edrv)
 105 {
 106         int r;
 107
 108         edrv->driver.bus = &eisa_bus_type;
 109         if ((r = driver_register (&edrv->driver)) < 0)
 110                 return r;
 111
 112         return 1;
 113 }
 114
 115 void eisa_driver_unregister (struct eisa_driver *edrv)
 116 {
 117         driver_unregister (&edrv->driver);
 118 }
 119
 120 static ssize_t eisa_show_sig (struct device *dev, char *buf)
 121 {
 122         struct eisa_device *edev = to_eisa_device (dev);
 123         return sprintf (buf,"%s\n", edev->id.sig);
 124 }
 125
 126 static DEVICE_ATTR(signature, S_IRUGO, eisa_show_sig, NULL);
 127
 128 static void __init eisa_register_device (char *sig, int slot)
 129 {
 130         struct eisa_device *edev;
 131
 132         if (!(edev = kmalloc (sizeof (*edev), GFP_KERNEL)))
 133                 return;
 134
 135         memset (edev, 0, sizeof (*edev));
 136         memcpy (edev->id.sig, sig, 7);
 137         edev->slot = slot;
 138         edev->base_addr = 0x1000 * slot;
 139         eisa_name_device (edev);
 140         edev->dev.parent = &eisa_bus_root;
 141         edev->dev.bus = &eisa_bus_type;
 142         sprintf (edev->dev.bus_id, "00:%02X", slot);
 143
 144         /* Don't register resource for slot 0, since this will surely
 145          * fail... :-( */
 146
 147         if (slot) {
 148                 edev->res.name  = edev->dev.name;
 149                 edev->res.start = edev->base_addr;
 150                 edev->res.end   = edev->res.start + 0xfff;
 151                 edev->res.flags = IORESOURCE_IO;
 152
 153                 if (request_resource (&ioport_resource, &edev->res)) {
 154                         printk (KERN_WARNING \
 155                                 "Cannot allocate resource for EISA slot %d\n",
 156                                 slot);
 157                         kfree (edev);
 158                         return;
 159                 }
 160         }
 161
 162         if (device_register (&edev->dev)) {
 163                 kfree (edev);
 164                 return;
 165         }
 166
 167         device_create_file (&edev->dev, &dev_attr_signature);
 168 }
 169
 170 static int __init eisa_probe (void)
 171 {
 172         int i, c;
 173         char *str;
 174         unsigned long slot_addr;
 175
 176         printk (KERN_INFO "EISA: Probing bus...\n");
 177         for (c = 0, i = 0; i <= EISA_MAX_SLOTS; i++) {
 178                 slot_addr = (0x1000 * i) + EISA_VENDOR_ID_OFFSET;
 179                 if ((str = decode_eisa_sig (slot_addr))) {
 180                         if (!i)
 181                                 printk (KERN_INFO "EISA: Motherboard %s detected\n",
 182                                         str);
 183                         else {
 184                                 printk (KERN_INFO "EISA: slot %d : %s detected.\n",
 185                                         i, str);
 186
 187                                 c++;
 188                         }
 189
 190                         eisa_register_device (str, i);
 191                 }
 192         }
 193         printk (KERN_INFO "EISA: Detected %d card%s.\n", c, c < 2 ? "" : "s");
 194
 195         return 0;
 196 }
 197
 198 static int __init eisa_init (void)
 199 {
 200         int r;
 201
 202         if ((r = bus_register (&eisa_bus_type)))
 203                 return r;
 204
 205         if ((r = device_register (&eisa_bus_root))) {
 206                 bus_unregister (&eisa_bus_type);
 207                 return r;
 208         }
 209
 210         printk (KERN_INFO "EISA bus registered\n");
 211         return eisa_probe ();
 212 }
 213
 214 postcore_initcall (eisa_init);
 215
 216 EXPORT_SYMBOL (eisa_bus_type);
 217 EXPORT_SYMBOL (eisa_driver_register);
 218 EXPORT_SYMBOL (eisa_driver_unregister);