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