0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023 #include <linux/module.h>
0024 #include <linux/string.h>
0025 #include <linux/types.h>
0026 #include <linux/init.h>
0027 #include <linux/stat.h>
0028 #include <linux/err.h>
0029 #include <linux/ctype.h>
0030 #include <linux/slab.h>
0031 #include <linux/limits.h>
0032 #include <linux/device.h>
0033 #include <linux/pci.h>
0034 #include <linux/blkdev.h>
0035 #include <linux/edd.h>
0036
0037 #define EDD_VERSION "0.16"
0038 #define EDD_DATE "2004-Jun-25"
0039
0040 MODULE_AUTHOR("Matt Domsch <Matt_Domsch@Dell.com>");
0041 MODULE_DESCRIPTION("sysfs interface to BIOS EDD information");
0042 MODULE_LICENSE("GPL");
0043 MODULE_VERSION(EDD_VERSION);
0044
0045 #define left (PAGE_SIZE - (p - buf) - 1)
0046
0047 struct edd_device {
0048 unsigned int index;
0049 unsigned int mbr_signature;
0050 struct edd_info *info;
0051 struct kobject kobj;
0052 };
0053
0054 struct edd_attribute {
0055 struct attribute attr;
0056 ssize_t(*show) (struct edd_device * edev, char *buf);
0057 int (*test) (struct edd_device * edev);
0058 };
0059
0060
0061 static int edd_dev_is_type(struct edd_device *edev, const char *type);
0062 static struct pci_dev *edd_get_pci_dev(struct edd_device *edev);
0063
0064 static struct edd_device *edd_devices[EDD_MBR_SIG_MAX];
0065
0066 #define EDD_DEVICE_ATTR(_name,_mode,_show,_test) \
0067 struct edd_attribute edd_attr_##_name = { \
0068 .attr = {.name = __stringify(_name), .mode = _mode }, \
0069 .show = _show, \
0070 .test = _test, \
0071 };
0072
0073 static int
0074 edd_has_mbr_signature(struct edd_device *edev)
0075 {
0076 return edev->index < min_t(unsigned char, edd.mbr_signature_nr, EDD_MBR_SIG_MAX);
0077 }
0078
0079 static int
0080 edd_has_edd_info(struct edd_device *edev)
0081 {
0082 return edev->index < min_t(unsigned char, edd.edd_info_nr, EDDMAXNR);
0083 }
0084
0085 static inline struct edd_info *
0086 edd_dev_get_info(struct edd_device *edev)
0087 {
0088 return edev->info;
0089 }
0090
0091 static inline void
0092 edd_dev_set_info(struct edd_device *edev, int i)
0093 {
0094 edev->index = i;
0095 if (edd_has_mbr_signature(edev))
0096 edev->mbr_signature = edd.mbr_signature[i];
0097 if (edd_has_edd_info(edev))
0098 edev->info = &edd.edd_info[i];
0099 }
0100
0101 #define to_edd_attr(_attr) container_of(_attr,struct edd_attribute,attr)
0102 #define to_edd_device(obj) container_of(obj,struct edd_device,kobj)
0103
0104 static ssize_t
0105 edd_attr_show(struct kobject * kobj, struct attribute *attr, char *buf)
0106 {
0107 struct edd_device *dev = to_edd_device(kobj);
0108 struct edd_attribute *edd_attr = to_edd_attr(attr);
0109 ssize_t ret = -EIO;
0110
0111 if (edd_attr->show)
0112 ret = edd_attr->show(dev, buf);
0113 return ret;
0114 }
0115
0116 static const struct sysfs_ops edd_attr_ops = {
0117 .show = edd_attr_show,
0118 };
0119
0120 static ssize_t
0121 edd_show_host_bus(struct edd_device *edev, char *buf)
0122 {
0123 struct edd_info *info;
0124 char *p = buf;
0125 int i;
0126
0127 if (!edev)
0128 return -EINVAL;
0129 info = edd_dev_get_info(edev);
0130 if (!info || !buf)
0131 return -EINVAL;
0132
0133 for (i = 0; i < 4; i++) {
0134 if (isprint(info->params.host_bus_type[i])) {
0135 p += scnprintf(p, left, "%c", info->params.host_bus_type[i]);
0136 } else {
0137 p += scnprintf(p, left, " ");
0138 }
0139 }
0140
0141 if (!strncmp(info->params.host_bus_type, "ISA", 3)) {
0142 p += scnprintf(p, left, "\tbase_address: %x\n",
0143 info->params.interface_path.isa.base_address);
0144 } else if (!strncmp(info->params.host_bus_type, "PCIX", 4) ||
0145 !strncmp(info->params.host_bus_type, "PCI", 3) ||
0146 !strncmp(info->params.host_bus_type, "XPRS", 4)) {
0147 p += scnprintf(p, left,
0148 "\t%02x:%02x.%d channel: %u\n",
0149 info->params.interface_path.pci.bus,
0150 info->params.interface_path.pci.slot,
0151 info->params.interface_path.pci.function,
0152 info->params.interface_path.pci.channel);
0153 } else if (!strncmp(info->params.host_bus_type, "IBND", 4) ||
0154 !strncmp(info->params.host_bus_type, "HTPT", 4)) {
0155 p += scnprintf(p, left,
0156 "\tTBD: %llx\n",
0157 info->params.interface_path.ibnd.reserved);
0158
0159 } else {
0160 p += scnprintf(p, left, "\tunknown: %llx\n",
0161 info->params.interface_path.unknown.reserved);
0162 }
0163 return (p - buf);
0164 }
0165
0166 static ssize_t
0167 edd_show_interface(struct edd_device *edev, char *buf)
0168 {
0169 struct edd_info *info;
0170 char *p = buf;
0171 int i;
0172
0173 if (!edev)
0174 return -EINVAL;
0175 info = edd_dev_get_info(edev);
0176 if (!info || !buf)
0177 return -EINVAL;
0178
0179 for (i = 0; i < 8; i++) {
0180 if (isprint(info->params.interface_type[i])) {
0181 p += scnprintf(p, left, "%c", info->params.interface_type[i]);
0182 } else {
0183 p += scnprintf(p, left, " ");
0184 }
0185 }
0186 if (!strncmp(info->params.interface_type, "ATAPI", 5)) {
0187 p += scnprintf(p, left, "\tdevice: %u lun: %u\n",
0188 info->params.device_path.atapi.device,
0189 info->params.device_path.atapi.lun);
0190 } else if (!strncmp(info->params.interface_type, "ATA", 3)) {
0191 p += scnprintf(p, left, "\tdevice: %u\n",
0192 info->params.device_path.ata.device);
0193 } else if (!strncmp(info->params.interface_type, "SCSI", 4)) {
0194 p += scnprintf(p, left, "\tid: %u lun: %llu\n",
0195 info->params.device_path.scsi.id,
0196 info->params.device_path.scsi.lun);
0197 } else if (!strncmp(info->params.interface_type, "USB", 3)) {
0198 p += scnprintf(p, left, "\tserial_number: %llx\n",
0199 info->params.device_path.usb.serial_number);
0200 } else if (!strncmp(info->params.interface_type, "1394", 4)) {
0201 p += scnprintf(p, left, "\teui: %llx\n",
0202 info->params.device_path.i1394.eui);
0203 } else if (!strncmp(info->params.interface_type, "FIBRE", 5)) {
0204 p += scnprintf(p, left, "\twwid: %llx lun: %llx\n",
0205 info->params.device_path.fibre.wwid,
0206 info->params.device_path.fibre.lun);
0207 } else if (!strncmp(info->params.interface_type, "I2O", 3)) {
0208 p += scnprintf(p, left, "\tidentity_tag: %llx\n",
0209 info->params.device_path.i2o.identity_tag);
0210 } else if (!strncmp(info->params.interface_type, "RAID", 4)) {
0211 p += scnprintf(p, left, "\tidentity_tag: %x\n",
0212 info->params.device_path.raid.array_number);
0213 } else if (!strncmp(info->params.interface_type, "SATA", 4)) {
0214 p += scnprintf(p, left, "\tdevice: %u\n",
0215 info->params.device_path.sata.device);
0216 } else {
0217 p += scnprintf(p, left, "\tunknown: %llx %llx\n",
0218 info->params.device_path.unknown.reserved1,
0219 info->params.device_path.unknown.reserved2);
0220 }
0221
0222 return (p - buf);
0223 }
0224
0225
0226
0227
0228
0229
0230
0231
0232 static ssize_t
0233 edd_show_raw_data(struct edd_device *edev, char *buf)
0234 {
0235 struct edd_info *info;
0236 ssize_t len = sizeof (info->params);
0237 if (!edev)
0238 return -EINVAL;
0239 info = edd_dev_get_info(edev);
0240 if (!info || !buf)
0241 return -EINVAL;
0242
0243 if (!(info->params.key == 0xBEDD || info->params.key == 0xDDBE))
0244 len = info->params.length;
0245
0246
0247 if (len > (sizeof(info->params)))
0248 len = sizeof(info->params);
0249
0250 memcpy(buf, &info->params, len);
0251 return len;
0252 }
0253
0254 static ssize_t
0255 edd_show_version(struct edd_device *edev, char *buf)
0256 {
0257 struct edd_info *info;
0258 char *p = buf;
0259 if (!edev)
0260 return -EINVAL;
0261 info = edd_dev_get_info(edev);
0262 if (!info || !buf)
0263 return -EINVAL;
0264
0265 p += scnprintf(p, left, "0x%02x\n", info->version);
0266 return (p - buf);
0267 }
0268
0269 static ssize_t
0270 edd_show_mbr_signature(struct edd_device *edev, char *buf)
0271 {
0272 char *p = buf;
0273 p += scnprintf(p, left, "0x%08x\n", edev->mbr_signature);
0274 return (p - buf);
0275 }
0276
0277 static ssize_t
0278 edd_show_extensions(struct edd_device *edev, char *buf)
0279 {
0280 struct edd_info *info;
0281 char *p = buf;
0282 if (!edev)
0283 return -EINVAL;
0284 info = edd_dev_get_info(edev);
0285 if (!info || !buf)
0286 return -EINVAL;
0287
0288 if (info->interface_support & EDD_EXT_FIXED_DISK_ACCESS) {
0289 p += scnprintf(p, left, "Fixed disk access\n");
0290 }
0291 if (info->interface_support & EDD_EXT_DEVICE_LOCKING_AND_EJECTING) {
0292 p += scnprintf(p, left, "Device locking and ejecting\n");
0293 }
0294 if (info->interface_support & EDD_EXT_ENHANCED_DISK_DRIVE_SUPPORT) {
0295 p += scnprintf(p, left, "Enhanced Disk Drive support\n");
0296 }
0297 if (info->interface_support & EDD_EXT_64BIT_EXTENSIONS) {
0298 p += scnprintf(p, left, "64-bit extensions\n");
0299 }
0300 return (p - buf);
0301 }
0302
0303 static ssize_t
0304 edd_show_info_flags(struct edd_device *edev, char *buf)
0305 {
0306 struct edd_info *info;
0307 char *p = buf;
0308 if (!edev)
0309 return -EINVAL;
0310 info = edd_dev_get_info(edev);
0311 if (!info || !buf)
0312 return -EINVAL;
0313
0314 if (info->params.info_flags & EDD_INFO_DMA_BOUNDARY_ERROR_TRANSPARENT)
0315 p += scnprintf(p, left, "DMA boundary error transparent\n");
0316 if (info->params.info_flags & EDD_INFO_GEOMETRY_VALID)
0317 p += scnprintf(p, left, "geometry valid\n");
0318 if (info->params.info_flags & EDD_INFO_REMOVABLE)
0319 p += scnprintf(p, left, "removable\n");
0320 if (info->params.info_flags & EDD_INFO_WRITE_VERIFY)
0321 p += scnprintf(p, left, "write verify\n");
0322 if (info->params.info_flags & EDD_INFO_MEDIA_CHANGE_NOTIFICATION)
0323 p += scnprintf(p, left, "media change notification\n");
0324 if (info->params.info_flags & EDD_INFO_LOCKABLE)
0325 p += scnprintf(p, left, "lockable\n");
0326 if (info->params.info_flags & EDD_INFO_NO_MEDIA_PRESENT)
0327 p += scnprintf(p, left, "no media present\n");
0328 if (info->params.info_flags & EDD_INFO_USE_INT13_FN50)
0329 p += scnprintf(p, left, "use int13 fn50\n");
0330 return (p - buf);
0331 }
0332
0333 static ssize_t
0334 edd_show_legacy_max_cylinder(struct edd_device *edev, char *buf)
0335 {
0336 struct edd_info *info;
0337 char *p = buf;
0338 if (!edev)
0339 return -EINVAL;
0340 info = edd_dev_get_info(edev);
0341 if (!info || !buf)
0342 return -EINVAL;
0343
0344 p += scnprintf(p, left, "%u\n", info->legacy_max_cylinder);
0345 return (p - buf);
0346 }
0347
0348 static ssize_t
0349 edd_show_legacy_max_head(struct edd_device *edev, char *buf)
0350 {
0351 struct edd_info *info;
0352 char *p = buf;
0353 if (!edev)
0354 return -EINVAL;
0355 info = edd_dev_get_info(edev);
0356 if (!info || !buf)
0357 return -EINVAL;
0358
0359 p += scnprintf(p, left, "%u\n", info->legacy_max_head);
0360 return (p - buf);
0361 }
0362
0363 static ssize_t
0364 edd_show_legacy_sectors_per_track(struct edd_device *edev, char *buf)
0365 {
0366 struct edd_info *info;
0367 char *p = buf;
0368 if (!edev)
0369 return -EINVAL;
0370 info = edd_dev_get_info(edev);
0371 if (!info || !buf)
0372 return -EINVAL;
0373
0374 p += scnprintf(p, left, "%u\n", info->legacy_sectors_per_track);
0375 return (p - buf);
0376 }
0377
0378 static ssize_t
0379 edd_show_default_cylinders(struct edd_device *edev, char *buf)
0380 {
0381 struct edd_info *info;
0382 char *p = buf;
0383 if (!edev)
0384 return -EINVAL;
0385 info = edd_dev_get_info(edev);
0386 if (!info || !buf)
0387 return -EINVAL;
0388
0389 p += scnprintf(p, left, "%u\n", info->params.num_default_cylinders);
0390 return (p - buf);
0391 }
0392
0393 static ssize_t
0394 edd_show_default_heads(struct edd_device *edev, char *buf)
0395 {
0396 struct edd_info *info;
0397 char *p = buf;
0398 if (!edev)
0399 return -EINVAL;
0400 info = edd_dev_get_info(edev);
0401 if (!info || !buf)
0402 return -EINVAL;
0403
0404 p += scnprintf(p, left, "%u\n", info->params.num_default_heads);
0405 return (p - buf);
0406 }
0407
0408 static ssize_t
0409 edd_show_default_sectors_per_track(struct edd_device *edev, char *buf)
0410 {
0411 struct edd_info *info;
0412 char *p = buf;
0413 if (!edev)
0414 return -EINVAL;
0415 info = edd_dev_get_info(edev);
0416 if (!info || !buf)
0417 return -EINVAL;
0418
0419 p += scnprintf(p, left, "%u\n", info->params.sectors_per_track);
0420 return (p - buf);
0421 }
0422
0423 static ssize_t
0424 edd_show_sectors(struct edd_device *edev, char *buf)
0425 {
0426 struct edd_info *info;
0427 char *p = buf;
0428 if (!edev)
0429 return -EINVAL;
0430 info = edd_dev_get_info(edev);
0431 if (!info || !buf)
0432 return -EINVAL;
0433
0434 p += scnprintf(p, left, "%llu\n", info->params.number_of_sectors);
0435 return (p - buf);
0436 }
0437
0438
0439
0440
0441
0442
0443
0444
0445
0446
0447
0448
0449 static int
0450 edd_has_legacy_max_cylinder(struct edd_device *edev)
0451 {
0452 struct edd_info *info;
0453 if (!edev)
0454 return 0;
0455 info = edd_dev_get_info(edev);
0456 if (!info)
0457 return 0;
0458 return info->legacy_max_cylinder > 0;
0459 }
0460
0461 static int
0462 edd_has_legacy_max_head(struct edd_device *edev)
0463 {
0464 struct edd_info *info;
0465 if (!edev)
0466 return 0;
0467 info = edd_dev_get_info(edev);
0468 if (!info)
0469 return 0;
0470 return info->legacy_max_head > 0;
0471 }
0472
0473 static int
0474 edd_has_legacy_sectors_per_track(struct edd_device *edev)
0475 {
0476 struct edd_info *info;
0477 if (!edev)
0478 return 0;
0479 info = edd_dev_get_info(edev);
0480 if (!info)
0481 return 0;
0482 return info->legacy_sectors_per_track > 0;
0483 }
0484
0485 static int
0486 edd_has_default_cylinders(struct edd_device *edev)
0487 {
0488 struct edd_info *info;
0489 if (!edev)
0490 return 0;
0491 info = edd_dev_get_info(edev);
0492 if (!info)
0493 return 0;
0494 return info->params.num_default_cylinders > 0;
0495 }
0496
0497 static int
0498 edd_has_default_heads(struct edd_device *edev)
0499 {
0500 struct edd_info *info;
0501 if (!edev)
0502 return 0;
0503 info = edd_dev_get_info(edev);
0504 if (!info)
0505 return 0;
0506 return info->params.num_default_heads > 0;
0507 }
0508
0509 static int
0510 edd_has_default_sectors_per_track(struct edd_device *edev)
0511 {
0512 struct edd_info *info;
0513 if (!edev)
0514 return 0;
0515 info = edd_dev_get_info(edev);
0516 if (!info)
0517 return 0;
0518 return info->params.sectors_per_track > 0;
0519 }
0520
0521 static int
0522 edd_has_edd30(struct edd_device *edev)
0523 {
0524 struct edd_info *info;
0525 int i;
0526 u8 csum = 0;
0527
0528 if (!edev)
0529 return 0;
0530 info = edd_dev_get_info(edev);
0531 if (!info)
0532 return 0;
0533
0534 if (!(info->params.key == 0xBEDD || info->params.key == 0xDDBE)) {
0535 return 0;
0536 }
0537
0538
0539
0540 if (info->params.device_path_info_length != 44)
0541 return 0;
0542
0543 for (i = 30; i < info->params.device_path_info_length + 30; i++)
0544 csum += *(((u8 *)&info->params) + i);
0545
0546 if (csum)
0547 return 0;
0548
0549 return 1;
0550 }
0551
0552
0553 static EDD_DEVICE_ATTR(raw_data, 0444, edd_show_raw_data, edd_has_edd_info);
0554 static EDD_DEVICE_ATTR(version, 0444, edd_show_version, edd_has_edd_info);
0555 static EDD_DEVICE_ATTR(extensions, 0444, edd_show_extensions, edd_has_edd_info);
0556 static EDD_DEVICE_ATTR(info_flags, 0444, edd_show_info_flags, edd_has_edd_info);
0557 static EDD_DEVICE_ATTR(sectors, 0444, edd_show_sectors, edd_has_edd_info);
0558 static EDD_DEVICE_ATTR(legacy_max_cylinder, 0444,
0559 edd_show_legacy_max_cylinder,
0560 edd_has_legacy_max_cylinder);
0561 static EDD_DEVICE_ATTR(legacy_max_head, 0444, edd_show_legacy_max_head,
0562 edd_has_legacy_max_head);
0563 static EDD_DEVICE_ATTR(legacy_sectors_per_track, 0444,
0564 edd_show_legacy_sectors_per_track,
0565 edd_has_legacy_sectors_per_track);
0566 static EDD_DEVICE_ATTR(default_cylinders, 0444, edd_show_default_cylinders,
0567 edd_has_default_cylinders);
0568 static EDD_DEVICE_ATTR(default_heads, 0444, edd_show_default_heads,
0569 edd_has_default_heads);
0570 static EDD_DEVICE_ATTR(default_sectors_per_track, 0444,
0571 edd_show_default_sectors_per_track,
0572 edd_has_default_sectors_per_track);
0573 static EDD_DEVICE_ATTR(interface, 0444, edd_show_interface, edd_has_edd30);
0574 static EDD_DEVICE_ATTR(host_bus, 0444, edd_show_host_bus, edd_has_edd30);
0575 static EDD_DEVICE_ATTR(mbr_signature, 0444, edd_show_mbr_signature, edd_has_mbr_signature);
0576
0577
0578 static struct edd_attribute * edd_attrs[] = {
0579 &edd_attr_raw_data,
0580 &edd_attr_version,
0581 &edd_attr_extensions,
0582 &edd_attr_info_flags,
0583 &edd_attr_sectors,
0584 &edd_attr_legacy_max_cylinder,
0585 &edd_attr_legacy_max_head,
0586 &edd_attr_legacy_sectors_per_track,
0587 &edd_attr_default_cylinders,
0588 &edd_attr_default_heads,
0589 &edd_attr_default_sectors_per_track,
0590 &edd_attr_interface,
0591 &edd_attr_host_bus,
0592 &edd_attr_mbr_signature,
0593 NULL,
0594 };
0595
0596
0597
0598
0599
0600
0601
0602
0603
0604
0605 static void edd_release(struct kobject * kobj)
0606 {
0607 struct edd_device * dev = to_edd_device(kobj);
0608 kfree(dev);
0609 }
0610
0611 static struct kobj_type edd_ktype = {
0612 .release = edd_release,
0613 .sysfs_ops = &edd_attr_ops,
0614 };
0615
0616 static struct kset *edd_kset;
0617
0618
0619
0620
0621
0622
0623
0624
0625
0626 static int
0627 edd_dev_is_type(struct edd_device *edev, const char *type)
0628 {
0629 struct edd_info *info;
0630 if (!edev)
0631 return 0;
0632 info = edd_dev_get_info(edev);
0633
0634 if (type && info) {
0635 if (!strncmp(info->params.host_bus_type, type, strlen(type)) ||
0636 !strncmp(info->params.interface_type, type, strlen(type)))
0637 return 1;
0638 }
0639 return 0;
0640 }
0641
0642
0643
0644
0645
0646
0647
0648 static struct pci_dev *
0649 edd_get_pci_dev(struct edd_device *edev)
0650 {
0651 struct edd_info *info = edd_dev_get_info(edev);
0652
0653 if (edd_dev_is_type(edev, "PCI") || edd_dev_is_type(edev, "XPRS")) {
0654 return pci_get_domain_bus_and_slot(0,
0655 info->params.interface_path.pci.bus,
0656 PCI_DEVFN(info->params.interface_path.pci.slot,
0657 info->params.interface_path.pci.function));
0658 }
0659 return NULL;
0660 }
0661
0662 static int
0663 edd_create_symlink_to_pcidev(struct edd_device *edev)
0664 {
0665
0666 struct pci_dev *pci_dev = edd_get_pci_dev(edev);
0667 int ret;
0668 if (!pci_dev)
0669 return 1;
0670 ret = sysfs_create_link(&edev->kobj,&pci_dev->dev.kobj,"pci_dev");
0671 pci_dev_put(pci_dev);
0672 return ret;
0673 }
0674
0675 static inline void
0676 edd_device_unregister(struct edd_device *edev)
0677 {
0678 kobject_put(&edev->kobj);
0679 }
0680
0681 static void edd_populate_dir(struct edd_device * edev)
0682 {
0683 struct edd_attribute * attr;
0684 int error = 0;
0685 int i;
0686
0687 for (i = 0; (attr = edd_attrs[i]) && !error; i++) {
0688 if (!attr->test || attr->test(edev))
0689 error = sysfs_create_file(&edev->kobj,&attr->attr);
0690 }
0691
0692 if (!error) {
0693 edd_create_symlink_to_pcidev(edev);
0694 }
0695 }
0696
0697 static int
0698 edd_device_register(struct edd_device *edev, int i)
0699 {
0700 int error;
0701
0702 if (!edev)
0703 return 1;
0704 edd_dev_set_info(edev, i);
0705 edev->kobj.kset = edd_kset;
0706 error = kobject_init_and_add(&edev->kobj, &edd_ktype, NULL,
0707 "int13_dev%02x", 0x80 + i);
0708 if (!error) {
0709 edd_populate_dir(edev);
0710 kobject_uevent(&edev->kobj, KOBJ_ADD);
0711 }
0712 return error;
0713 }
0714
0715 static inline int edd_num_devices(void)
0716 {
0717 return max_t(unsigned char,
0718 min_t(unsigned char, EDD_MBR_SIG_MAX, edd.mbr_signature_nr),
0719 min_t(unsigned char, EDDMAXNR, edd.edd_info_nr));
0720 }
0721
0722
0723
0724
0725 static int __init
0726 edd_init(void)
0727 {
0728 int i;
0729 int rc=0;
0730 struct edd_device *edev;
0731
0732 if (!edd_num_devices())
0733 return -ENODEV;
0734
0735 printk(KERN_INFO "BIOS EDD facility v%s %s, %d devices found\n",
0736 EDD_VERSION, EDD_DATE, edd_num_devices());
0737
0738 edd_kset = kset_create_and_add("edd", NULL, firmware_kobj);
0739 if (!edd_kset)
0740 return -ENOMEM;
0741
0742 for (i = 0; i < edd_num_devices(); i++) {
0743 edev = kzalloc(sizeof (*edev), GFP_KERNEL);
0744 if (!edev) {
0745 rc = -ENOMEM;
0746 goto out;
0747 }
0748
0749 rc = edd_device_register(edev, i);
0750 if (rc) {
0751 kfree(edev);
0752 goto out;
0753 }
0754 edd_devices[i] = edev;
0755 }
0756
0757 return 0;
0758
0759 out:
0760 while (--i >= 0)
0761 edd_device_unregister(edd_devices[i]);
0762 kset_unregister(edd_kset);
0763 return rc;
0764 }
0765
0766 static void __exit
0767 edd_exit(void)
0768 {
0769 int i;
0770 struct edd_device *edev;
0771
0772 for (i = 0; i < edd_num_devices(); i++) {
0773 if ((edev = edd_devices[i]))
0774 edd_device_unregister(edev);
0775 }
0776 kset_unregister(edd_kset);
0777 }
0778
0779 late_initcall(edd_init);
0780 module_exit(edd_exit);