edd.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * linux/drivers/firmware/edd.c
  4. * Copyright (C) 2002, 2003, 2004 Dell Inc.
  5. * by Matt Domsch <Matt_Domsch@dell.com>
  6. * disk signature by Matt Domsch, Andrew Wilks, and Sandeep K. Shandilya
  7. * legacy CHS by Patrick J. LoPresti <patl@users.sourceforge.net>
  8. *
  9. * BIOS Enhanced Disk Drive Services (EDD)
  10. * conformant to T13 Committee www.t13.org
  11. * projects 1572D, 1484D, 1386D, 1226DT
  12. *
  13. * This code takes information provided by BIOS EDD calls
  14. * fn41 - Check Extensions Present and
  15. * fn48 - Get Device Parameters with EDD extensions
  16. * made in setup.S, copied to safe structures in setup.c,
  17. * and presents it in sysfs.
  18. *
  19. * Please see http://linux.dell.com/edd/results.html for
  20. * the list of BIOSs which have been reported to implement EDD.
  21. */
  22. #include <linux/module.h>
  23. #include <linux/string.h>
  24. #include <linux/types.h>
  25. #include <linux/init.h>
  26. #include <linux/stat.h>
  27. #include <linux/err.h>
  28. #include <linux/ctype.h>
  29. #include <linux/slab.h>
  30. #include <linux/limits.h>
  31. #include <linux/device.h>
  32. #include <linux/pci.h>
  33. #include <linux/blkdev.h>
  34. #include <linux/edd.h>
  35. #define EDD_VERSION "0.16"
  36. #define EDD_DATE "2004-Jun-25"
  37. MODULE_AUTHOR("Matt Domsch <Matt_Domsch@Dell.com>");
  38. MODULE_DESCRIPTION("sysfs interface to BIOS EDD information");
  39. MODULE_LICENSE("GPL");
  40. MODULE_VERSION(EDD_VERSION);
  41. #define left (PAGE_SIZE - (p - buf) - 1)
  42. struct edd_device {
  43. unsigned int index;
  44. unsigned int mbr_signature;
  45. struct edd_info *info;
  46. struct kobject kobj;
  47. };
  48. struct edd_attribute {
  49. struct attribute attr;
  50. ssize_t(*show) (struct edd_device * edev, char *buf);
  51. int (*test) (struct edd_device * edev);
  52. };
  53. /* forward declarations */
  54. static int edd_dev_is_type(struct edd_device *edev, const char *type);
  55. static struct pci_dev *edd_get_pci_dev(struct edd_device *edev);
  56. static struct edd_device *edd_devices[EDD_MBR_SIG_MAX];
  57. #define EDD_DEVICE_ATTR(_name,_mode,_show,_test) \
  58. struct edd_attribute edd_attr_##_name = { \
  59. .attr = {.name = __stringify(_name), .mode = _mode }, \
  60. .show = _show, \
  61. .test = _test, \
  62. };
  63. static int
  64. edd_has_mbr_signature(struct edd_device *edev)
  65. {
  66. return edev->index < min_t(unsigned char, edd.mbr_signature_nr, EDD_MBR_SIG_MAX);
  67. }
  68. static int
  69. edd_has_edd_info(struct edd_device *edev)
  70. {
  71. return edev->index < min_t(unsigned char, edd.edd_info_nr, EDDMAXNR);
  72. }
  73. static inline struct edd_info *
  74. edd_dev_get_info(struct edd_device *edev)
  75. {
  76. return edev->info;
  77. }
  78. static inline void
  79. edd_dev_set_info(struct edd_device *edev, int i)
  80. {
  81. edev->index = i;
  82. if (edd_has_mbr_signature(edev))
  83. edev->mbr_signature = edd.mbr_signature[i];
  84. if (edd_has_edd_info(edev))
  85. edev->info = &edd.edd_info[i];
  86. }
  87. #define to_edd_attr(_attr) container_of(_attr,struct edd_attribute,attr)
  88. #define to_edd_device(obj) container_of(obj,struct edd_device,kobj)
  89. static ssize_t
  90. edd_attr_show(struct kobject * kobj, struct attribute *attr, char *buf)
  91. {
  92. struct edd_device *dev = to_edd_device(kobj);
  93. struct edd_attribute *edd_attr = to_edd_attr(attr);
  94. ssize_t ret = -EIO;
  95. if (edd_attr->show)
  96. ret = edd_attr->show(dev, buf);
  97. return ret;
  98. }
  99. static const struct sysfs_ops edd_attr_ops = {
  100. .show = edd_attr_show,
  101. };
  102. static ssize_t
  103. edd_show_host_bus(struct edd_device *edev, char *buf)
  104. {
  105. struct edd_info *info;
  106. char *p = buf;
  107. int i;
  108. if (!edev)
  109. return -EINVAL;
  110. info = edd_dev_get_info(edev);
  111. if (!info || !buf)
  112. return -EINVAL;
  113. for (i = 0; i < 4; i++) {
  114. if (isprint(info->params.host_bus_type[i])) {
  115. p += scnprintf(p, left, "%c", info->params.host_bus_type[i]);
  116. } else {
  117. p += scnprintf(p, left, " ");
  118. }
  119. }
  120. if (!strncmp(info->params.host_bus_type, "ISA", 3)) {
  121. p += scnprintf(p, left, "\tbase_address: %x\n",
  122. info->params.interface_path.isa.base_address);
  123. } else if (!strncmp(info->params.host_bus_type, "PCIX", 4) ||
  124. !strncmp(info->params.host_bus_type, "PCI", 3) ||
  125. !strncmp(info->params.host_bus_type, "XPRS", 4)) {
  126. p += scnprintf(p, left,
  127. "\t%02x:%02x.%d channel: %u\n",
  128. info->params.interface_path.pci.bus,
  129. info->params.interface_path.pci.slot,
  130. info->params.interface_path.pci.function,
  131. info->params.interface_path.pci.channel);
  132. } else if (!strncmp(info->params.host_bus_type, "IBND", 4) ||
  133. !strncmp(info->params.host_bus_type, "HTPT", 4)) {
  134. p += scnprintf(p, left,
  135. "\tTBD: %llx\n",
  136. info->params.interface_path.ibnd.reserved);
  137. } else {
  138. p += scnprintf(p, left, "\tunknown: %llx\n",
  139. info->params.interface_path.unknown.reserved);
  140. }
  141. return (p - buf);
  142. }
  143. static ssize_t
  144. edd_show_interface(struct edd_device *edev, char *buf)
  145. {
  146. struct edd_info *info;
  147. char *p = buf;
  148. int i;
  149. if (!edev)
  150. return -EINVAL;
  151. info = edd_dev_get_info(edev);
  152. if (!info || !buf)
  153. return -EINVAL;
  154. for (i = 0; i < 8; i++) {
  155. if (isprint(info->params.interface_type[i])) {
  156. p += scnprintf(p, left, "%c", info->params.interface_type[i]);
  157. } else {
  158. p += scnprintf(p, left, " ");
  159. }
  160. }
  161. if (!strncmp(info->params.interface_type, "ATAPI", 5)) {
  162. p += scnprintf(p, left, "\tdevice: %u lun: %u\n",
  163. info->params.device_path.atapi.device,
  164. info->params.device_path.atapi.lun);
  165. } else if (!strncmp(info->params.interface_type, "ATA", 3)) {
  166. p += scnprintf(p, left, "\tdevice: %u\n",
  167. info->params.device_path.ata.device);
  168. } else if (!strncmp(info->params.interface_type, "SCSI", 4)) {
  169. p += scnprintf(p, left, "\tid: %u lun: %llu\n",
  170. info->params.device_path.scsi.id,
  171. info->params.device_path.scsi.lun);
  172. } else if (!strncmp(info->params.interface_type, "USB", 3)) {
  173. p += scnprintf(p, left, "\tserial_number: %llx\n",
  174. info->params.device_path.usb.serial_number);
  175. } else if (!strncmp(info->params.interface_type, "1394", 4)) {
  176. p += scnprintf(p, left, "\teui: %llx\n",
  177. info->params.device_path.i1394.eui);
  178. } else if (!strncmp(info->params.interface_type, "FIBRE", 5)) {
  179. p += scnprintf(p, left, "\twwid: %llx lun: %llx\n",
  180. info->params.device_path.fibre.wwid,
  181. info->params.device_path.fibre.lun);
  182. } else if (!strncmp(info->params.interface_type, "I2O", 3)) {
  183. p += scnprintf(p, left, "\tidentity_tag: %llx\n",
  184. info->params.device_path.i2o.identity_tag);
  185. } else if (!strncmp(info->params.interface_type, "RAID", 4)) {
  186. p += scnprintf(p, left, "\tidentity_tag: %x\n",
  187. info->params.device_path.raid.array_number);
  188. } else if (!strncmp(info->params.interface_type, "SATA", 4)) {
  189. p += scnprintf(p, left, "\tdevice: %u\n",
  190. info->params.device_path.sata.device);
  191. } else {
  192. p += scnprintf(p, left, "\tunknown: %llx %llx\n",
  193. info->params.device_path.unknown.reserved1,
  194. info->params.device_path.unknown.reserved2);
  195. }
  196. return (p - buf);
  197. }
  198. /**
  199. * edd_show_raw_data() - copies raw data to buffer for userspace to parse
  200. * @edev: target edd_device
  201. * @buf: output buffer
  202. *
  203. * Returns: number of bytes written, or -EINVAL on failure
  204. */
  205. static ssize_t
  206. edd_show_raw_data(struct edd_device *edev, char *buf)
  207. {
  208. struct edd_info *info;
  209. ssize_t len = sizeof (info->params);
  210. if (!edev)
  211. return -EINVAL;
  212. info = edd_dev_get_info(edev);
  213. if (!info || !buf)
  214. return -EINVAL;
  215. if (!(info->params.key == 0xBEDD || info->params.key == 0xDDBE))
  216. len = info->params.length;
  217. /* In case of buggy BIOSs */
  218. if (len > (sizeof(info->params)))
  219. len = sizeof(info->params);
  220. memcpy(buf, &info->params, len);
  221. return len;
  222. }
  223. static ssize_t
  224. edd_show_version(struct edd_device *edev, char *buf)
  225. {
  226. struct edd_info *info;
  227. char *p = buf;
  228. if (!edev)
  229. return -EINVAL;
  230. info = edd_dev_get_info(edev);
  231. if (!info || !buf)
  232. return -EINVAL;
  233. p += scnprintf(p, left, "0x%02x\n", info->version);
  234. return (p - buf);
  235. }
  236. static ssize_t
  237. edd_show_mbr_signature(struct edd_device *edev, char *buf)
  238. {
  239. char *p = buf;
  240. p += scnprintf(p, left, "0x%08x\n", edev->mbr_signature);
  241. return (p - buf);
  242. }
  243. static ssize_t
  244. edd_show_extensions(struct edd_device *edev, char *buf)
  245. {
  246. struct edd_info *info;
  247. char *p = buf;
  248. if (!edev)
  249. return -EINVAL;
  250. info = edd_dev_get_info(edev);
  251. if (!info || !buf)
  252. return -EINVAL;
  253. if (info->interface_support & EDD_EXT_FIXED_DISK_ACCESS) {
  254. p += scnprintf(p, left, "Fixed disk access\n");
  255. }
  256. if (info->interface_support & EDD_EXT_DEVICE_LOCKING_AND_EJECTING) {
  257. p += scnprintf(p, left, "Device locking and ejecting\n");
  258. }
  259. if (info->interface_support & EDD_EXT_ENHANCED_DISK_DRIVE_SUPPORT) {
  260. p += scnprintf(p, left, "Enhanced Disk Drive support\n");
  261. }
  262. if (info->interface_support & EDD_EXT_64BIT_EXTENSIONS) {
  263. p += scnprintf(p, left, "64-bit extensions\n");
  264. }
  265. return (p - buf);
  266. }
  267. static ssize_t
  268. edd_show_info_flags(struct edd_device *edev, char *buf)
  269. {
  270. struct edd_info *info;
  271. char *p = buf;
  272. if (!edev)
  273. return -EINVAL;
  274. info = edd_dev_get_info(edev);
  275. if (!info || !buf)
  276. return -EINVAL;
  277. if (info->params.info_flags & EDD_INFO_DMA_BOUNDARY_ERROR_TRANSPARENT)
  278. p += scnprintf(p, left, "DMA boundary error transparent\n");
  279. if (info->params.info_flags & EDD_INFO_GEOMETRY_VALID)
  280. p += scnprintf(p, left, "geometry valid\n");
  281. if (info->params.info_flags & EDD_INFO_REMOVABLE)
  282. p += scnprintf(p, left, "removable\n");
  283. if (info->params.info_flags & EDD_INFO_WRITE_VERIFY)
  284. p += scnprintf(p, left, "write verify\n");
  285. if (info->params.info_flags & EDD_INFO_MEDIA_CHANGE_NOTIFICATION)
  286. p += scnprintf(p, left, "media change notification\n");
  287. if (info->params.info_flags & EDD_INFO_LOCKABLE)
  288. p += scnprintf(p, left, "lockable\n");
  289. if (info->params.info_flags & EDD_INFO_NO_MEDIA_PRESENT)
  290. p += scnprintf(p, left, "no media present\n");
  291. if (info->params.info_flags & EDD_INFO_USE_INT13_FN50)
  292. p += scnprintf(p, left, "use int13 fn50\n");
  293. return (p - buf);
  294. }
  295. static ssize_t
  296. edd_show_legacy_max_cylinder(struct edd_device *edev, char *buf)
  297. {
  298. struct edd_info *info;
  299. char *p = buf;
  300. if (!edev)
  301. return -EINVAL;
  302. info = edd_dev_get_info(edev);
  303. if (!info || !buf)
  304. return -EINVAL;
  305. p += scnprintf(p, left, "%u\n", info->legacy_max_cylinder);
  306. return (p - buf);
  307. }
  308. static ssize_t
  309. edd_show_legacy_max_head(struct edd_device *edev, char *buf)
  310. {
  311. struct edd_info *info;
  312. char *p = buf;
  313. if (!edev)
  314. return -EINVAL;
  315. info = edd_dev_get_info(edev);
  316. if (!info || !buf)
  317. return -EINVAL;
  318. p += scnprintf(p, left, "%u\n", info->legacy_max_head);
  319. return (p - buf);
  320. }
  321. static ssize_t
  322. edd_show_legacy_sectors_per_track(struct edd_device *edev, char *buf)
  323. {
  324. struct edd_info *info;
  325. char *p = buf;
  326. if (!edev)
  327. return -EINVAL;
  328. info = edd_dev_get_info(edev);
  329. if (!info || !buf)
  330. return -EINVAL;
  331. p += scnprintf(p, left, "%u\n", info->legacy_sectors_per_track);
  332. return (p - buf);
  333. }
  334. static ssize_t
  335. edd_show_default_cylinders(struct edd_device *edev, char *buf)
  336. {
  337. struct edd_info *info;
  338. char *p = buf;
  339. if (!edev)
  340. return -EINVAL;
  341. info = edd_dev_get_info(edev);
  342. if (!info || !buf)
  343. return -EINVAL;
  344. p += scnprintf(p, left, "%u\n", info->params.num_default_cylinders);
  345. return (p - buf);
  346. }
  347. static ssize_t
  348. edd_show_default_heads(struct edd_device *edev, char *buf)
  349. {
  350. struct edd_info *info;
  351. char *p = buf;
  352. if (!edev)
  353. return -EINVAL;
  354. info = edd_dev_get_info(edev);
  355. if (!info || !buf)
  356. return -EINVAL;
  357. p += scnprintf(p, left, "%u\n", info->params.num_default_heads);
  358. return (p - buf);
  359. }
  360. static ssize_t
  361. edd_show_default_sectors_per_track(struct edd_device *edev, char *buf)
  362. {
  363. struct edd_info *info;
  364. char *p = buf;
  365. if (!edev)
  366. return -EINVAL;
  367. info = edd_dev_get_info(edev);
  368. if (!info || !buf)
  369. return -EINVAL;
  370. p += scnprintf(p, left, "%u\n", info->params.sectors_per_track);
  371. return (p - buf);
  372. }
  373. static ssize_t
  374. edd_show_sectors(struct edd_device *edev, char *buf)
  375. {
  376. struct edd_info *info;
  377. char *p = buf;
  378. if (!edev)
  379. return -EINVAL;
  380. info = edd_dev_get_info(edev);
  381. if (!info || !buf)
  382. return -EINVAL;
  383. p += scnprintf(p, left, "%llu\n", info->params.number_of_sectors);
  384. return (p - buf);
  385. }
  386. /*
  387. * Some device instances may not have all the above attributes,
  388. * or the attribute values may be meaningless (i.e. if
  389. * the device is < EDD 3.0, it won't have host_bus and interface
  390. * information), so don't bother making files for them. Likewise
  391. * if the default_{cylinders,heads,sectors_per_track} values
  392. * are zero, the BIOS doesn't provide sane values, don't bother
  393. * creating files for them either.
  394. */
  395. static int
  396. edd_has_legacy_max_cylinder(struct edd_device *edev)
  397. {
  398. struct edd_info *info;
  399. if (!edev)
  400. return 0;
  401. info = edd_dev_get_info(edev);
  402. if (!info)
  403. return 0;
  404. return info->legacy_max_cylinder > 0;
  405. }
  406. static int
  407. edd_has_legacy_max_head(struct edd_device *edev)
  408. {
  409. struct edd_info *info;
  410. if (!edev)
  411. return 0;
  412. info = edd_dev_get_info(edev);
  413. if (!info)
  414. return 0;
  415. return info->legacy_max_head > 0;
  416. }
  417. static int
  418. edd_has_legacy_sectors_per_track(struct edd_device *edev)
  419. {
  420. struct edd_info *info;
  421. if (!edev)
  422. return 0;
  423. info = edd_dev_get_info(edev);
  424. if (!info)
  425. return 0;
  426. return info->legacy_sectors_per_track > 0;
  427. }
  428. static int
  429. edd_has_default_cylinders(struct edd_device *edev)
  430. {
  431. struct edd_info *info;
  432. if (!edev)
  433. return 0;
  434. info = edd_dev_get_info(edev);
  435. if (!info)
  436. return 0;
  437. return info->params.num_default_cylinders > 0;
  438. }
  439. static int
  440. edd_has_default_heads(struct edd_device *edev)
  441. {
  442. struct edd_info *info;
  443. if (!edev)
  444. return 0;
  445. info = edd_dev_get_info(edev);
  446. if (!info)
  447. return 0;
  448. return info->params.num_default_heads > 0;
  449. }
  450. static int
  451. edd_has_default_sectors_per_track(struct edd_device *edev)
  452. {
  453. struct edd_info *info;
  454. if (!edev)
  455. return 0;
  456. info = edd_dev_get_info(edev);
  457. if (!info)
  458. return 0;
  459. return info->params.sectors_per_track > 0;
  460. }
  461. static int
  462. edd_has_edd30(struct edd_device *edev)
  463. {
  464. struct edd_info *info;
  465. int i;
  466. u8 csum = 0;
  467. if (!edev)
  468. return 0;
  469. info = edd_dev_get_info(edev);
  470. if (!info)
  471. return 0;
  472. if (!(info->params.key == 0xBEDD || info->params.key == 0xDDBE)) {
  473. return 0;
  474. }
  475. /* We support only T13 spec */
  476. if (info->params.device_path_info_length != 44)
  477. return 0;
  478. for (i = 30; i < info->params.device_path_info_length + 30; i++)
  479. csum += *(((u8 *)&info->params) + i);
  480. if (csum)
  481. return 0;
  482. return 1;
  483. }
  484. static EDD_DEVICE_ATTR(raw_data, 0444, edd_show_raw_data, edd_has_edd_info);
  485. static EDD_DEVICE_ATTR(version, 0444, edd_show_version, edd_has_edd_info);
  486. static EDD_DEVICE_ATTR(extensions, 0444, edd_show_extensions, edd_has_edd_info);
  487. static EDD_DEVICE_ATTR(info_flags, 0444, edd_show_info_flags, edd_has_edd_info);
  488. static EDD_DEVICE_ATTR(sectors, 0444, edd_show_sectors, edd_has_edd_info);
  489. static EDD_DEVICE_ATTR(legacy_max_cylinder, 0444,
  490. edd_show_legacy_max_cylinder,
  491. edd_has_legacy_max_cylinder);
  492. static EDD_DEVICE_ATTR(legacy_max_head, 0444, edd_show_legacy_max_head,
  493. edd_has_legacy_max_head);
  494. static EDD_DEVICE_ATTR(legacy_sectors_per_track, 0444,
  495. edd_show_legacy_sectors_per_track,
  496. edd_has_legacy_sectors_per_track);
  497. static EDD_DEVICE_ATTR(default_cylinders, 0444, edd_show_default_cylinders,
  498. edd_has_default_cylinders);
  499. static EDD_DEVICE_ATTR(default_heads, 0444, edd_show_default_heads,
  500. edd_has_default_heads);
  501. static EDD_DEVICE_ATTR(default_sectors_per_track, 0444,
  502. edd_show_default_sectors_per_track,
  503. edd_has_default_sectors_per_track);
  504. static EDD_DEVICE_ATTR(interface, 0444, edd_show_interface, edd_has_edd30);
  505. static EDD_DEVICE_ATTR(host_bus, 0444, edd_show_host_bus, edd_has_edd30);
  506. static EDD_DEVICE_ATTR(mbr_signature, 0444, edd_show_mbr_signature, edd_has_mbr_signature);
  507. /* These are default attributes that are added for every edd
  508. * device discovered. There are none.
  509. */
  510. static struct attribute * def_attrs[] = {
  511. NULL,
  512. };
  513. /* These attributes are conditional and only added for some devices. */
  514. static struct edd_attribute * edd_attrs[] = {
  515. &edd_attr_raw_data,
  516. &edd_attr_version,
  517. &edd_attr_extensions,
  518. &edd_attr_info_flags,
  519. &edd_attr_sectors,
  520. &edd_attr_legacy_max_cylinder,
  521. &edd_attr_legacy_max_head,
  522. &edd_attr_legacy_sectors_per_track,
  523. &edd_attr_default_cylinders,
  524. &edd_attr_default_heads,
  525. &edd_attr_default_sectors_per_track,
  526. &edd_attr_interface,
  527. &edd_attr_host_bus,
  528. &edd_attr_mbr_signature,
  529. NULL,
  530. };
  531. /**
  532. * edd_release - free edd structure
  533. * @kobj: kobject of edd structure
  534. *
  535. * This is called when the refcount of the edd structure
  536. * reaches 0. This should happen right after we unregister,
  537. * but just in case, we use the release callback anyway.
  538. */
  539. static void edd_release(struct kobject * kobj)
  540. {
  541. struct edd_device * dev = to_edd_device(kobj);
  542. kfree(dev);
  543. }
  544. static struct kobj_type edd_ktype = {
  545. .release = edd_release,
  546. .sysfs_ops = &edd_attr_ops,
  547. .default_attrs = def_attrs,
  548. };
  549. static struct kset *edd_kset;
  550. /**
  551. * edd_dev_is_type() - is this EDD device a 'type' device?
  552. * @edev: target edd_device
  553. * @type: a host bus or interface identifier string per the EDD spec
  554. *
  555. * Returns 1 (TRUE) if it is a 'type' device, 0 otherwise.
  556. */
  557. static int
  558. edd_dev_is_type(struct edd_device *edev, const char *type)
  559. {
  560. struct edd_info *info;
  561. if (!edev)
  562. return 0;
  563. info = edd_dev_get_info(edev);
  564. if (type && info) {
  565. if (!strncmp(info->params.host_bus_type, type, strlen(type)) ||
  566. !strncmp(info->params.interface_type, type, strlen(type)))
  567. return 1;
  568. }
  569. return 0;
  570. }
  571. /**
  572. * edd_get_pci_dev() - finds pci_dev that matches edev
  573. * @edev: edd_device
  574. *
  575. * Returns pci_dev if found, or NULL
  576. */
  577. static struct pci_dev *
  578. edd_get_pci_dev(struct edd_device *edev)
  579. {
  580. struct edd_info *info = edd_dev_get_info(edev);
  581. if (edd_dev_is_type(edev, "PCI") || edd_dev_is_type(edev, "XPRS")) {
  582. return pci_get_domain_bus_and_slot(0,
  583. info->params.interface_path.pci.bus,
  584. PCI_DEVFN(info->params.interface_path.pci.slot,
  585. info->params.interface_path.pci.function));
  586. }
  587. return NULL;
  588. }
  589. static int
  590. edd_create_symlink_to_pcidev(struct edd_device *edev)
  591. {
  592. struct pci_dev *pci_dev = edd_get_pci_dev(edev);
  593. int ret;
  594. if (!pci_dev)
  595. return 1;
  596. ret = sysfs_create_link(&edev->kobj,&pci_dev->dev.kobj,"pci_dev");
  597. pci_dev_put(pci_dev);
  598. return ret;
  599. }
  600. static inline void
  601. edd_device_unregister(struct edd_device *edev)
  602. {
  603. kobject_put(&edev->kobj);
  604. }
  605. static void edd_populate_dir(struct edd_device * edev)
  606. {
  607. struct edd_attribute * attr;
  608. int error = 0;
  609. int i;
  610. for (i = 0; (attr = edd_attrs[i]) && !error; i++) {
  611. if (!attr->test ||
  612. (attr->test && attr->test(edev)))
  613. error = sysfs_create_file(&edev->kobj,&attr->attr);
  614. }
  615. if (!error) {
  616. edd_create_symlink_to_pcidev(edev);
  617. }
  618. }
  619. static int
  620. edd_device_register(struct edd_device *edev, int i)
  621. {
  622. int error;
  623. if (!edev)
  624. return 1;
  625. edd_dev_set_info(edev, i);
  626. edev->kobj.kset = edd_kset;
  627. error = kobject_init_and_add(&edev->kobj, &edd_ktype, NULL,
  628. "int13_dev%02x", 0x80 + i);
  629. if (!error) {
  630. edd_populate_dir(edev);
  631. kobject_uevent(&edev->kobj, KOBJ_ADD);
  632. }
  633. return error;
  634. }
  635. static inline int edd_num_devices(void)
  636. {
  637. return max_t(unsigned char,
  638. min_t(unsigned char, EDD_MBR_SIG_MAX, edd.mbr_signature_nr),
  639. min_t(unsigned char, EDDMAXNR, edd.edd_info_nr));
  640. }
  641. /**
  642. * edd_init() - creates sysfs tree of EDD data
  643. */
  644. static int __init
  645. edd_init(void)
  646. {
  647. int i;
  648. int rc=0;
  649. struct edd_device *edev;
  650. if (!edd_num_devices())
  651. return -ENODEV;
  652. printk(KERN_INFO "BIOS EDD facility v%s %s, %d devices found\n",
  653. EDD_VERSION, EDD_DATE, edd_num_devices());
  654. edd_kset = kset_create_and_add("edd", NULL, firmware_kobj);
  655. if (!edd_kset)
  656. return -ENOMEM;
  657. for (i = 0; i < edd_num_devices(); i++) {
  658. edev = kzalloc(sizeof (*edev), GFP_KERNEL);
  659. if (!edev) {
  660. rc = -ENOMEM;
  661. goto out;
  662. }
  663. rc = edd_device_register(edev, i);
  664. if (rc) {
  665. kfree(edev);
  666. goto out;
  667. }
  668. edd_devices[i] = edev;
  669. }
  670. return 0;
  671. out:
  672. while (--i >= 0)
  673. edd_device_unregister(edd_devices[i]);
  674. kset_unregister(edd_kset);
  675. return rc;
  676. }
  677. static void __exit
  678. edd_exit(void)
  679. {
  680. int i;
  681. struct edd_device *edev;
  682. for (i = 0; i < edd_num_devices(); i++) {
  683. if ((edev = edd_devices[i]))
  684. edd_device_unregister(edev);
  685. }
  686. kset_unregister(edd_kset);
  687. }
  688. late_initcall(edd_init);
  689. module_exit(edd_exit);