xref: /openbmc/linux/drivers/firmware/dmi-sysfs.c (revision a3857a5c)
1948af1f0SMike Waychison /*
2948af1f0SMike Waychison  * dmi-sysfs.c
3948af1f0SMike Waychison  *
4948af1f0SMike Waychison  * This module exports the DMI tables read-only to userspace through the
5948af1f0SMike Waychison  * sysfs file system.
6948af1f0SMike Waychison  *
7948af1f0SMike Waychison  * Data is currently found below
8948af1f0SMike Waychison  *    /sys/firmware/dmi/...
9948af1f0SMike Waychison  *
10948af1f0SMike Waychison  * DMI attributes are presented in attribute files with names
11948af1f0SMike Waychison  * formatted using %d-%d, so that the first integer indicates the
12948af1f0SMike Waychison  * structure type (0-255), and the second field is the instance of that
13948af1f0SMike Waychison  * entry.
14948af1f0SMike Waychison  *
15948af1f0SMike Waychison  * Copyright 2011 Google, Inc.
16948af1f0SMike Waychison  */
17948af1f0SMike Waychison 
18948af1f0SMike Waychison #include <linux/kernel.h>
19948af1f0SMike Waychison #include <linux/init.h>
20948af1f0SMike Waychison #include <linux/module.h>
21948af1f0SMike Waychison #include <linux/types.h>
22948af1f0SMike Waychison #include <linux/kobject.h>
23948af1f0SMike Waychison #include <linux/dmi.h>
24948af1f0SMike Waychison #include <linux/capability.h>
25948af1f0SMike Waychison #include <linux/slab.h>
26948af1f0SMike Waychison #include <linux/list.h>
27948af1f0SMike Waychison #include <linux/io.h>
28948af1f0SMike Waychison 
29948af1f0SMike Waychison #define MAX_ENTRY_TYPE 255 /* Most of these aren't used, but we consider
30948af1f0SMike Waychison 			      the top entry type is only 8 bits */
31948af1f0SMike Waychison 
32948af1f0SMike Waychison struct dmi_sysfs_entry {
33948af1f0SMike Waychison 	struct dmi_header dh;
34948af1f0SMike Waychison 	struct kobject kobj;
35948af1f0SMike Waychison 	int instance;
36948af1f0SMike Waychison 	int position;
37948af1f0SMike Waychison 	struct list_head list;
38925a1da7SMike Waychison 	struct kobject *child;
39948af1f0SMike Waychison };
40948af1f0SMike Waychison 
41948af1f0SMike Waychison /*
42948af1f0SMike Waychison  * Global list of dmi_sysfs_entry.  Even though this should only be
43948af1f0SMike Waychison  * manipulated at setup and teardown, the lazy nature of the kobject
44948af1f0SMike Waychison  * system means we get lazy removes.
45948af1f0SMike Waychison  */
46948af1f0SMike Waychison static LIST_HEAD(entry_list);
47948af1f0SMike Waychison static DEFINE_SPINLOCK(entry_list_lock);
48948af1f0SMike Waychison 
49948af1f0SMike Waychison /* dmi_sysfs_attribute - Top level attribute. used by all entries. */
50948af1f0SMike Waychison struct dmi_sysfs_attribute {
51948af1f0SMike Waychison 	struct attribute attr;
52948af1f0SMike Waychison 	ssize_t (*show)(struct dmi_sysfs_entry *entry, char *buf);
53948af1f0SMike Waychison };
54948af1f0SMike Waychison 
55948af1f0SMike Waychison #define DMI_SYSFS_ATTR(_entry, _name) \
56948af1f0SMike Waychison struct dmi_sysfs_attribute dmi_sysfs_attr_##_entry##_##_name = { \
57948af1f0SMike Waychison 	.attr = {.name = __stringify(_name), .mode = 0400}, \
58948af1f0SMike Waychison 	.show = dmi_sysfs_##_entry##_##_name, \
59948af1f0SMike Waychison }
60948af1f0SMike Waychison 
61948af1f0SMike Waychison /*
62948af1f0SMike Waychison  * dmi_sysfs_mapped_attribute - Attribute where we require the entry be
63948af1f0SMike Waychison  * mapped in.  Use in conjunction with dmi_sysfs_specialize_attr_ops.
64948af1f0SMike Waychison  */
65948af1f0SMike Waychison struct dmi_sysfs_mapped_attribute {
66948af1f0SMike Waychison 	struct attribute attr;
67948af1f0SMike Waychison 	ssize_t (*show)(struct dmi_sysfs_entry *entry,
68948af1f0SMike Waychison 			const struct dmi_header *dh,
69948af1f0SMike Waychison 			char *buf);
70948af1f0SMike Waychison };
71948af1f0SMike Waychison 
72948af1f0SMike Waychison #define DMI_SYSFS_MAPPED_ATTR(_entry, _name) \
73948af1f0SMike Waychison struct dmi_sysfs_mapped_attribute dmi_sysfs_attr_##_entry##_##_name = { \
74948af1f0SMike Waychison 	.attr = {.name = __stringify(_name), .mode = 0400}, \
75948af1f0SMike Waychison 	.show = dmi_sysfs_##_entry##_##_name, \
76948af1f0SMike Waychison }
77948af1f0SMike Waychison 
78948af1f0SMike Waychison /*************************************************
79948af1f0SMike Waychison  * Generic DMI entry support.
80948af1f0SMike Waychison  *************************************************/
81925a1da7SMike Waychison static void dmi_entry_free(struct kobject *kobj)
82925a1da7SMike Waychison {
83925a1da7SMike Waychison 	kfree(kobj);
84925a1da7SMike Waychison }
85948af1f0SMike Waychison 
86948af1f0SMike Waychison static struct dmi_sysfs_entry *to_entry(struct kobject *kobj)
87948af1f0SMike Waychison {
88948af1f0SMike Waychison 	return container_of(kobj, struct dmi_sysfs_entry, kobj);
89948af1f0SMike Waychison }
90948af1f0SMike Waychison 
91948af1f0SMike Waychison static struct dmi_sysfs_attribute *to_attr(struct attribute *attr)
92948af1f0SMike Waychison {
93948af1f0SMike Waychison 	return container_of(attr, struct dmi_sysfs_attribute, attr);
94948af1f0SMike Waychison }
95948af1f0SMike Waychison 
96948af1f0SMike Waychison static ssize_t dmi_sysfs_attr_show(struct kobject *kobj,
97948af1f0SMike Waychison 				   struct attribute *_attr, char *buf)
98948af1f0SMike Waychison {
99948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry = to_entry(kobj);
100948af1f0SMike Waychison 	struct dmi_sysfs_attribute *attr = to_attr(_attr);
101948af1f0SMike Waychison 
102948af1f0SMike Waychison 	/* DMI stuff is only ever admin visible */
103948af1f0SMike Waychison 	if (!capable(CAP_SYS_ADMIN))
104948af1f0SMike Waychison 		return -EACCES;
105948af1f0SMike Waychison 
106948af1f0SMike Waychison 	return attr->show(entry, buf);
107948af1f0SMike Waychison }
108948af1f0SMike Waychison 
109948af1f0SMike Waychison static const struct sysfs_ops dmi_sysfs_attr_ops = {
110948af1f0SMike Waychison 	.show = dmi_sysfs_attr_show,
111948af1f0SMike Waychison };
112948af1f0SMike Waychison 
113948af1f0SMike Waychison typedef ssize_t (*dmi_callback)(struct dmi_sysfs_entry *,
114948af1f0SMike Waychison 				const struct dmi_header *dh, void *);
115948af1f0SMike Waychison 
116948af1f0SMike Waychison struct find_dmi_data {
117948af1f0SMike Waychison 	struct dmi_sysfs_entry	*entry;
118948af1f0SMike Waychison 	dmi_callback		callback;
119948af1f0SMike Waychison 	void			*private;
120948af1f0SMike Waychison 	int			instance_countdown;
121948af1f0SMike Waychison 	ssize_t			ret;
122948af1f0SMike Waychison };
123948af1f0SMike Waychison 
124948af1f0SMike Waychison static void find_dmi_entry_helper(const struct dmi_header *dh,
125948af1f0SMike Waychison 				  void *_data)
126948af1f0SMike Waychison {
127948af1f0SMike Waychison 	struct find_dmi_data *data = _data;
128948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry = data->entry;
129948af1f0SMike Waychison 
130948af1f0SMike Waychison 	/* Is this the entry we want? */
131948af1f0SMike Waychison 	if (dh->type != entry->dh.type)
132948af1f0SMike Waychison 		return;
133948af1f0SMike Waychison 
134948af1f0SMike Waychison 	if (data->instance_countdown != 0) {
135948af1f0SMike Waychison 		/* try the next instance? */
136948af1f0SMike Waychison 		data->instance_countdown--;
137948af1f0SMike Waychison 		return;
138948af1f0SMike Waychison 	}
139948af1f0SMike Waychison 
140948af1f0SMike Waychison 	/*
141948af1f0SMike Waychison 	 * Don't ever revisit the instance.  Short circuit later
142948af1f0SMike Waychison 	 * instances by letting the instance_countdown run negative
143948af1f0SMike Waychison 	 */
144948af1f0SMike Waychison 	data->instance_countdown--;
145948af1f0SMike Waychison 
146948af1f0SMike Waychison 	/* Found the entry */
147948af1f0SMike Waychison 	data->ret = data->callback(entry, dh, data->private);
148948af1f0SMike Waychison }
149948af1f0SMike Waychison 
150948af1f0SMike Waychison /* State for passing the read parameters through dmi_find_entry() */
151948af1f0SMike Waychison struct dmi_read_state {
152948af1f0SMike Waychison 	char *buf;
153948af1f0SMike Waychison 	loff_t pos;
154948af1f0SMike Waychison 	size_t count;
155948af1f0SMike Waychison };
156948af1f0SMike Waychison 
157948af1f0SMike Waychison static ssize_t find_dmi_entry(struct dmi_sysfs_entry *entry,
158948af1f0SMike Waychison 			      dmi_callback callback, void *private)
159948af1f0SMike Waychison {
160948af1f0SMike Waychison 	struct find_dmi_data data = {
161948af1f0SMike Waychison 		.entry = entry,
162948af1f0SMike Waychison 		.callback = callback,
163948af1f0SMike Waychison 		.private = private,
164948af1f0SMike Waychison 		.instance_countdown = entry->instance,
165948af1f0SMike Waychison 		.ret = -EIO,  /* To signal the entry disappeared */
166948af1f0SMike Waychison 	};
167948af1f0SMike Waychison 	int ret;
168948af1f0SMike Waychison 
169948af1f0SMike Waychison 	ret = dmi_walk(find_dmi_entry_helper, &data);
170948af1f0SMike Waychison 	/* This shouldn't happen, but just in case. */
171948af1f0SMike Waychison 	if (ret)
172948af1f0SMike Waychison 		return -EINVAL;
173948af1f0SMike Waychison 	return data.ret;
174948af1f0SMike Waychison }
175948af1f0SMike Waychison 
176948af1f0SMike Waychison /*
177948af1f0SMike Waychison  * Calculate and return the byte length of the dmi entry identified by
178948af1f0SMike Waychison  * dh.  This includes both the formatted portion as well as the
179948af1f0SMike Waychison  * unformatted string space, including the two trailing nul characters.
180948af1f0SMike Waychison  */
181948af1f0SMike Waychison static size_t dmi_entry_length(const struct dmi_header *dh)
182948af1f0SMike Waychison {
183948af1f0SMike Waychison 	const char *p = (const char *)dh;
184948af1f0SMike Waychison 
185948af1f0SMike Waychison 	p += dh->length;
186948af1f0SMike Waychison 
187948af1f0SMike Waychison 	while (p[0] || p[1])
188948af1f0SMike Waychison 		p++;
189948af1f0SMike Waychison 
190948af1f0SMike Waychison 	return 2 + p - (const char *)dh;
191948af1f0SMike Waychison }
192948af1f0SMike Waychison 
193948af1f0SMike Waychison /*************************************************
194925a1da7SMike Waychison  * Support bits for specialized DMI entry support
195925a1da7SMike Waychison  *************************************************/
196925a1da7SMike Waychison struct dmi_entry_attr_show_data {
197925a1da7SMike Waychison 	struct attribute *attr;
198925a1da7SMike Waychison 	char *buf;
199925a1da7SMike Waychison };
200925a1da7SMike Waychison 
201925a1da7SMike Waychison static ssize_t dmi_entry_attr_show_helper(struct dmi_sysfs_entry *entry,
202925a1da7SMike Waychison 					  const struct dmi_header *dh,
203925a1da7SMike Waychison 					  void *_data)
204925a1da7SMike Waychison {
205925a1da7SMike Waychison 	struct dmi_entry_attr_show_data *data = _data;
206925a1da7SMike Waychison 	struct dmi_sysfs_mapped_attribute *attr;
207925a1da7SMike Waychison 
208925a1da7SMike Waychison 	attr = container_of(data->attr,
209925a1da7SMike Waychison 			    struct dmi_sysfs_mapped_attribute, attr);
210925a1da7SMike Waychison 	return attr->show(entry, dh, data->buf);
211925a1da7SMike Waychison }
212925a1da7SMike Waychison 
213925a1da7SMike Waychison static ssize_t dmi_entry_attr_show(struct kobject *kobj,
214925a1da7SMike Waychison 				   struct attribute *attr,
215925a1da7SMike Waychison 				   char *buf)
216925a1da7SMike Waychison {
217925a1da7SMike Waychison 	struct dmi_entry_attr_show_data data = {
218925a1da7SMike Waychison 		.attr = attr,
219925a1da7SMike Waychison 		.buf  = buf,
220925a1da7SMike Waychison 	};
221925a1da7SMike Waychison 	/* Find the entry according to our parent and call the
222925a1da7SMike Waychison 	 * normalized show method hanging off of the attribute */
223925a1da7SMike Waychison 	return find_dmi_entry(to_entry(kobj->parent),
224925a1da7SMike Waychison 			      dmi_entry_attr_show_helper, &data);
225925a1da7SMike Waychison }
226925a1da7SMike Waychison 
227925a1da7SMike Waychison static const struct sysfs_ops dmi_sysfs_specialize_attr_ops = {
228925a1da7SMike Waychison 	.show = dmi_entry_attr_show,
229925a1da7SMike Waychison };
230925a1da7SMike Waychison 
231925a1da7SMike Waychison /*************************************************
232925a1da7SMike Waychison  * Specialized DMI entry support.
233925a1da7SMike Waychison  *************************************************/
234925a1da7SMike Waychison 
235925a1da7SMike Waychison /*** Type 15 - System Event Table ***/
236925a1da7SMike Waychison 
237925a1da7SMike Waychison #define DMI_SEL_ACCESS_METHOD_IO8	0x00
238925a1da7SMike Waychison #define DMI_SEL_ACCESS_METHOD_IO2x8	0x01
239925a1da7SMike Waychison #define DMI_SEL_ACCESS_METHOD_IO16	0x02
240925a1da7SMike Waychison #define DMI_SEL_ACCESS_METHOD_PHYS32	0x03
241925a1da7SMike Waychison #define DMI_SEL_ACCESS_METHOD_GPNV	0x04
242925a1da7SMike Waychison 
243925a1da7SMike Waychison struct dmi_system_event_log {
244925a1da7SMike Waychison 	struct dmi_header header;
245925a1da7SMike Waychison 	u16	area_length;
246925a1da7SMike Waychison 	u16	header_start_offset;
247925a1da7SMike Waychison 	u16	data_start_offset;
248925a1da7SMike Waychison 	u8	access_method;
249925a1da7SMike Waychison 	u8	status;
250925a1da7SMike Waychison 	u32	change_token;
251925a1da7SMike Waychison 	union {
252925a1da7SMike Waychison 		struct {
253925a1da7SMike Waychison 			u16 index_addr;
254925a1da7SMike Waychison 			u16 data_addr;
255925a1da7SMike Waychison 		} io;
256925a1da7SMike Waychison 		u32	phys_addr32;
257925a1da7SMike Waychison 		u16	gpnv_handle;
258925a1da7SMike Waychison 		u32	access_method_address;
259925a1da7SMike Waychison 	};
260925a1da7SMike Waychison 	u8	header_format;
261925a1da7SMike Waychison 	u8	type_descriptors_supported_count;
262925a1da7SMike Waychison 	u8	per_log_type_descriptor_length;
263925a1da7SMike Waychison 	u8	supported_log_type_descriptos[0];
264925a1da7SMike Waychison } __packed;
265925a1da7SMike Waychison 
266925a1da7SMike Waychison static const struct dmi_system_event_log *to_sel(const struct dmi_header *dh)
267925a1da7SMike Waychison {
268925a1da7SMike Waychison 	return (const struct dmi_system_event_log *)dh;
269925a1da7SMike Waychison }
270925a1da7SMike Waychison 
271925a1da7SMike Waychison #define DMI_SYSFS_SEL_FIELD(_field) \
272925a1da7SMike Waychison static ssize_t dmi_sysfs_sel_##_field(struct dmi_sysfs_entry *entry, \
273925a1da7SMike Waychison 				      const struct dmi_header *dh, \
274925a1da7SMike Waychison 				      char *buf) \
275925a1da7SMike Waychison { \
276925a1da7SMike Waychison 	const struct dmi_system_event_log *sel = to_sel(dh); \
277925a1da7SMike Waychison 	if (sizeof(*sel) > dmi_entry_length(dh)) \
278925a1da7SMike Waychison 		return -EIO; \
279925a1da7SMike Waychison 	return sprintf(buf, "%u\n", sel->_field); \
280925a1da7SMike Waychison } \
281925a1da7SMike Waychison static DMI_SYSFS_MAPPED_ATTR(sel, _field)
282925a1da7SMike Waychison 
283925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(area_length);
284925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(header_start_offset);
285925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(data_start_offset);
286925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(access_method);
287925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(status);
288925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(change_token);
289925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(access_method_address);
290925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(header_format);
291925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(type_descriptors_supported_count);
292925a1da7SMike Waychison DMI_SYSFS_SEL_FIELD(per_log_type_descriptor_length);
293925a1da7SMike Waychison 
294925a1da7SMike Waychison static struct attribute *dmi_sysfs_sel_attrs[] = {
295925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_area_length.attr,
296925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_header_start_offset.attr,
297925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_data_start_offset.attr,
298925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_access_method.attr,
299925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_status.attr,
300925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_change_token.attr,
301925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_access_method_address.attr,
302925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_header_format.attr,
303925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_type_descriptors_supported_count.attr,
304925a1da7SMike Waychison 	&dmi_sysfs_attr_sel_per_log_type_descriptor_length.attr,
305925a1da7SMike Waychison 	NULL,
306925a1da7SMike Waychison };
307925a1da7SMike Waychison 
308925a1da7SMike Waychison 
309925a1da7SMike Waychison static struct kobj_type dmi_system_event_log_ktype = {
310925a1da7SMike Waychison 	.release = dmi_entry_free,
311925a1da7SMike Waychison 	.sysfs_ops = &dmi_sysfs_specialize_attr_ops,
312925a1da7SMike Waychison 	.default_attrs = dmi_sysfs_sel_attrs,
313925a1da7SMike Waychison };
314925a1da7SMike Waychison 
315a3857a5cSMike Waychison typedef u8 (*sel_io_reader)(const struct dmi_system_event_log *sel,
316a3857a5cSMike Waychison 			    loff_t offset);
317a3857a5cSMike Waychison 
318a3857a5cSMike Waychison static DEFINE_MUTEX(io_port_lock);
319a3857a5cSMike Waychison 
320a3857a5cSMike Waychison static u8 read_sel_8bit_indexed_io(const struct dmi_system_event_log *sel,
321a3857a5cSMike Waychison 				   loff_t offset)
322a3857a5cSMike Waychison {
323a3857a5cSMike Waychison 	u8 ret;
324a3857a5cSMike Waychison 
325a3857a5cSMike Waychison 	mutex_lock(&io_port_lock);
326a3857a5cSMike Waychison 	outb((u8)offset, sel->io.index_addr);
327a3857a5cSMike Waychison 	ret = inb(sel->io.data_addr);
328a3857a5cSMike Waychison 	mutex_unlock(&io_port_lock);
329a3857a5cSMike Waychison 	return ret;
330a3857a5cSMike Waychison }
331a3857a5cSMike Waychison 
332a3857a5cSMike Waychison static u8 read_sel_2x8bit_indexed_io(const struct dmi_system_event_log *sel,
333a3857a5cSMike Waychison 				     loff_t offset)
334a3857a5cSMike Waychison {
335a3857a5cSMike Waychison 	u8 ret;
336a3857a5cSMike Waychison 
337a3857a5cSMike Waychison 	mutex_lock(&io_port_lock);
338a3857a5cSMike Waychison 	outb((u8)offset, sel->io.index_addr);
339a3857a5cSMike Waychison 	outb((u8)(offset >> 8), sel->io.index_addr + 1);
340a3857a5cSMike Waychison 	ret = inb(sel->io.data_addr);
341a3857a5cSMike Waychison 	mutex_unlock(&io_port_lock);
342a3857a5cSMike Waychison 	return ret;
343a3857a5cSMike Waychison }
344a3857a5cSMike Waychison 
345a3857a5cSMike Waychison static u8 read_sel_16bit_indexed_io(const struct dmi_system_event_log *sel,
346a3857a5cSMike Waychison 				    loff_t offset)
347a3857a5cSMike Waychison {
348a3857a5cSMike Waychison 	u8 ret;
349a3857a5cSMike Waychison 
350a3857a5cSMike Waychison 	mutex_lock(&io_port_lock);
351a3857a5cSMike Waychison 	outw((u16)offset, sel->io.index_addr);
352a3857a5cSMike Waychison 	ret = inb(sel->io.data_addr);
353a3857a5cSMike Waychison 	mutex_unlock(&io_port_lock);
354a3857a5cSMike Waychison 	return ret;
355a3857a5cSMike Waychison }
356a3857a5cSMike Waychison 
357a3857a5cSMike Waychison static sel_io_reader sel_io_readers[] = {
358a3857a5cSMike Waychison 	[DMI_SEL_ACCESS_METHOD_IO8]	= read_sel_8bit_indexed_io,
359a3857a5cSMike Waychison 	[DMI_SEL_ACCESS_METHOD_IO2x8]	= read_sel_2x8bit_indexed_io,
360a3857a5cSMike Waychison 	[DMI_SEL_ACCESS_METHOD_IO16]	= read_sel_16bit_indexed_io,
361a3857a5cSMike Waychison };
362a3857a5cSMike Waychison 
363a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_io(struct dmi_sysfs_entry *entry,
364a3857a5cSMike Waychison 				   const struct dmi_system_event_log *sel,
365a3857a5cSMike Waychison 				   char *buf, loff_t pos, size_t count)
366a3857a5cSMike Waychison {
367a3857a5cSMike Waychison 	ssize_t wrote = 0;
368a3857a5cSMike Waychison 
369a3857a5cSMike Waychison 	sel_io_reader io_reader = sel_io_readers[sel->access_method];
370a3857a5cSMike Waychison 
371a3857a5cSMike Waychison 	while (count && pos < sel->area_length) {
372a3857a5cSMike Waychison 		count--;
373a3857a5cSMike Waychison 		*(buf++) = io_reader(sel, pos++);
374a3857a5cSMike Waychison 		wrote++;
375a3857a5cSMike Waychison 	}
376a3857a5cSMike Waychison 
377a3857a5cSMike Waychison 	return wrote;
378a3857a5cSMike Waychison }
379a3857a5cSMike Waychison 
380a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_phys32(struct dmi_sysfs_entry *entry,
381a3857a5cSMike Waychison 				       const struct dmi_system_event_log *sel,
382a3857a5cSMike Waychison 				       char *buf, loff_t pos, size_t count)
383a3857a5cSMike Waychison {
384a3857a5cSMike Waychison 	u8 __iomem *mapped;
385a3857a5cSMike Waychison 	ssize_t wrote = 0;
386a3857a5cSMike Waychison 
387a3857a5cSMike Waychison 	mapped = ioremap(sel->access_method_address, sel->area_length);
388a3857a5cSMike Waychison 	if (!mapped)
389a3857a5cSMike Waychison 		return -EIO;
390a3857a5cSMike Waychison 
391a3857a5cSMike Waychison 	while (count && pos < sel->area_length) {
392a3857a5cSMike Waychison 		count--;
393a3857a5cSMike Waychison 		*(buf++) = readb(mapped + pos++);
394a3857a5cSMike Waychison 		wrote++;
395a3857a5cSMike Waychison 	}
396a3857a5cSMike Waychison 
397a3857a5cSMike Waychison 	iounmap(mapped);
398a3857a5cSMike Waychison 	return wrote;
399a3857a5cSMike Waychison }
400a3857a5cSMike Waychison 
401a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_helper(struct dmi_sysfs_entry *entry,
402a3857a5cSMike Waychison 				       const struct dmi_header *dh,
403a3857a5cSMike Waychison 				       void *_state)
404a3857a5cSMike Waychison {
405a3857a5cSMike Waychison 	struct dmi_read_state *state = _state;
406a3857a5cSMike Waychison 	const struct dmi_system_event_log *sel = to_sel(dh);
407a3857a5cSMike Waychison 
408a3857a5cSMike Waychison 	if (sizeof(*sel) > dmi_entry_length(dh))
409a3857a5cSMike Waychison 		return -EIO;
410a3857a5cSMike Waychison 
411a3857a5cSMike Waychison 	switch (sel->access_method) {
412a3857a5cSMike Waychison 	case DMI_SEL_ACCESS_METHOD_IO8:
413a3857a5cSMike Waychison 	case DMI_SEL_ACCESS_METHOD_IO2x8:
414a3857a5cSMike Waychison 	case DMI_SEL_ACCESS_METHOD_IO16:
415a3857a5cSMike Waychison 		return dmi_sel_raw_read_io(entry, sel, state->buf,
416a3857a5cSMike Waychison 					   state->pos, state->count);
417a3857a5cSMike Waychison 	case DMI_SEL_ACCESS_METHOD_PHYS32:
418a3857a5cSMike Waychison 		return dmi_sel_raw_read_phys32(entry, sel, state->buf,
419a3857a5cSMike Waychison 					       state->pos, state->count);
420a3857a5cSMike Waychison 	case DMI_SEL_ACCESS_METHOD_GPNV:
421a3857a5cSMike Waychison 		pr_info("dmi-sysfs: GPNV support missing.\n");
422a3857a5cSMike Waychison 		return -EIO;
423a3857a5cSMike Waychison 	default:
424a3857a5cSMike Waychison 		pr_info("dmi-sysfs: Unknown access method %02x\n",
425a3857a5cSMike Waychison 			sel->access_method);
426a3857a5cSMike Waychison 		return -EIO;
427a3857a5cSMike Waychison 	}
428a3857a5cSMike Waychison }
429a3857a5cSMike Waychison 
430a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read(struct file *filp, struct kobject *kobj,
431a3857a5cSMike Waychison 				struct bin_attribute *bin_attr,
432a3857a5cSMike Waychison 				char *buf, loff_t pos, size_t count)
433a3857a5cSMike Waychison {
434a3857a5cSMike Waychison 	struct dmi_sysfs_entry *entry = to_entry(kobj->parent);
435a3857a5cSMike Waychison 	struct dmi_read_state state = {
436a3857a5cSMike Waychison 		.buf = buf,
437a3857a5cSMike Waychison 		.pos = pos,
438a3857a5cSMike Waychison 		.count = count,
439a3857a5cSMike Waychison 	};
440a3857a5cSMike Waychison 
441a3857a5cSMike Waychison 	return find_dmi_entry(entry, dmi_sel_raw_read_helper, &state);
442a3857a5cSMike Waychison }
443a3857a5cSMike Waychison 
444a3857a5cSMike Waychison static struct bin_attribute dmi_sel_raw_attr = {
445a3857a5cSMike Waychison 	.attr = {.name = "raw_event_log", .mode = 0400},
446a3857a5cSMike Waychison 	.read = dmi_sel_raw_read,
447a3857a5cSMike Waychison };
448a3857a5cSMike Waychison 
449925a1da7SMike Waychison static int dmi_system_event_log(struct dmi_sysfs_entry *entry)
450925a1da7SMike Waychison {
451925a1da7SMike Waychison 	int ret;
452925a1da7SMike Waychison 
453925a1da7SMike Waychison 	entry->child = kzalloc(sizeof(*entry->child), GFP_KERNEL);
454925a1da7SMike Waychison 	if (!entry->child)
455925a1da7SMike Waychison 		return -ENOMEM;
456925a1da7SMike Waychison 	ret = kobject_init_and_add(entry->child,
457925a1da7SMike Waychison 				   &dmi_system_event_log_ktype,
458925a1da7SMike Waychison 				   &entry->kobj,
459925a1da7SMike Waychison 				   "system_event_log");
460925a1da7SMike Waychison 	if (ret)
461925a1da7SMike Waychison 		goto out_free;
462a3857a5cSMike Waychison 
463a3857a5cSMike Waychison 	ret = sysfs_create_bin_file(entry->child, &dmi_sel_raw_attr);
464a3857a5cSMike Waychison 	if (ret)
465a3857a5cSMike Waychison 		goto out_del;
466a3857a5cSMike Waychison 
467a3857a5cSMike Waychison 	return 0;
468a3857a5cSMike Waychison 
469a3857a5cSMike Waychison out_del:
470a3857a5cSMike Waychison 	kobject_del(entry->child);
471925a1da7SMike Waychison out_free:
472925a1da7SMike Waychison 	kfree(entry->child);
473925a1da7SMike Waychison 	return ret;
474925a1da7SMike Waychison }
475925a1da7SMike Waychison 
476925a1da7SMike Waychison /*************************************************
477948af1f0SMike Waychison  * Generic DMI entry support.
478948af1f0SMike Waychison  *************************************************/
479948af1f0SMike Waychison 
480948af1f0SMike Waychison static ssize_t dmi_sysfs_entry_length(struct dmi_sysfs_entry *entry, char *buf)
481948af1f0SMike Waychison {
482948af1f0SMike Waychison 	return sprintf(buf, "%d\n", entry->dh.length);
483948af1f0SMike Waychison }
484948af1f0SMike Waychison 
485948af1f0SMike Waychison static ssize_t dmi_sysfs_entry_handle(struct dmi_sysfs_entry *entry, char *buf)
486948af1f0SMike Waychison {
487948af1f0SMike Waychison 	return sprintf(buf, "%d\n", entry->dh.handle);
488948af1f0SMike Waychison }
489948af1f0SMike Waychison 
490948af1f0SMike Waychison static ssize_t dmi_sysfs_entry_type(struct dmi_sysfs_entry *entry, char *buf)
491948af1f0SMike Waychison {
492948af1f0SMike Waychison 	return sprintf(buf, "%d\n", entry->dh.type);
493948af1f0SMike Waychison }
494948af1f0SMike Waychison 
495948af1f0SMike Waychison static ssize_t dmi_sysfs_entry_instance(struct dmi_sysfs_entry *entry,
496948af1f0SMike Waychison 					char *buf)
497948af1f0SMike Waychison {
498948af1f0SMike Waychison 	return sprintf(buf, "%d\n", entry->instance);
499948af1f0SMike Waychison }
500948af1f0SMike Waychison 
501948af1f0SMike Waychison static ssize_t dmi_sysfs_entry_position(struct dmi_sysfs_entry *entry,
502948af1f0SMike Waychison 					char *buf)
503948af1f0SMike Waychison {
504948af1f0SMike Waychison 	return sprintf(buf, "%d\n", entry->position);
505948af1f0SMike Waychison }
506948af1f0SMike Waychison 
507948af1f0SMike Waychison static DMI_SYSFS_ATTR(entry, length);
508948af1f0SMike Waychison static DMI_SYSFS_ATTR(entry, handle);
509948af1f0SMike Waychison static DMI_SYSFS_ATTR(entry, type);
510948af1f0SMike Waychison static DMI_SYSFS_ATTR(entry, instance);
511948af1f0SMike Waychison static DMI_SYSFS_ATTR(entry, position);
512948af1f0SMike Waychison 
513948af1f0SMike Waychison static struct attribute *dmi_sysfs_entry_attrs[] = {
514948af1f0SMike Waychison 	&dmi_sysfs_attr_entry_length.attr,
515948af1f0SMike Waychison 	&dmi_sysfs_attr_entry_handle.attr,
516948af1f0SMike Waychison 	&dmi_sysfs_attr_entry_type.attr,
517948af1f0SMike Waychison 	&dmi_sysfs_attr_entry_instance.attr,
518948af1f0SMike Waychison 	&dmi_sysfs_attr_entry_position.attr,
519948af1f0SMike Waychison 	NULL,
520948af1f0SMike Waychison };
521948af1f0SMike Waychison 
522948af1f0SMike Waychison static ssize_t dmi_entry_raw_read_helper(struct dmi_sysfs_entry *entry,
523948af1f0SMike Waychison 					 const struct dmi_header *dh,
524948af1f0SMike Waychison 					 void *_state)
525948af1f0SMike Waychison {
526948af1f0SMike Waychison 	struct dmi_read_state *state = _state;
527948af1f0SMike Waychison 	size_t entry_length;
528948af1f0SMike Waychison 
529948af1f0SMike Waychison 	entry_length = dmi_entry_length(dh);
530948af1f0SMike Waychison 
531948af1f0SMike Waychison 	return memory_read_from_buffer(state->buf, state->count,
532948af1f0SMike Waychison 				       &state->pos, dh, entry_length);
533948af1f0SMike Waychison }
534948af1f0SMike Waychison 
535948af1f0SMike Waychison static ssize_t dmi_entry_raw_read(struct file *filp,
536948af1f0SMike Waychison 				  struct kobject *kobj,
537948af1f0SMike Waychison 				  struct bin_attribute *bin_attr,
538948af1f0SMike Waychison 				  char *buf, loff_t pos, size_t count)
539948af1f0SMike Waychison {
540948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry = to_entry(kobj);
541948af1f0SMike Waychison 	struct dmi_read_state state = {
542948af1f0SMike Waychison 		.buf = buf,
543948af1f0SMike Waychison 		.pos = pos,
544948af1f0SMike Waychison 		.count = count,
545948af1f0SMike Waychison 	};
546948af1f0SMike Waychison 
547948af1f0SMike Waychison 	return find_dmi_entry(entry, dmi_entry_raw_read_helper, &state);
548948af1f0SMike Waychison }
549948af1f0SMike Waychison 
550948af1f0SMike Waychison static const struct bin_attribute dmi_entry_raw_attr = {
551948af1f0SMike Waychison 	.attr = {.name = "raw", .mode = 0400},
552948af1f0SMike Waychison 	.read = dmi_entry_raw_read,
553948af1f0SMike Waychison };
554948af1f0SMike Waychison 
555948af1f0SMike Waychison static void dmi_sysfs_entry_release(struct kobject *kobj)
556948af1f0SMike Waychison {
557948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry = to_entry(kobj);
558948af1f0SMike Waychison 	sysfs_remove_bin_file(&entry->kobj, &dmi_entry_raw_attr);
559948af1f0SMike Waychison 	spin_lock(&entry_list_lock);
560948af1f0SMike Waychison 	list_del(&entry->list);
561948af1f0SMike Waychison 	spin_unlock(&entry_list_lock);
562948af1f0SMike Waychison 	kfree(entry);
563948af1f0SMike Waychison }
564948af1f0SMike Waychison 
565948af1f0SMike Waychison static struct kobj_type dmi_sysfs_entry_ktype = {
566948af1f0SMike Waychison 	.release = dmi_sysfs_entry_release,
567948af1f0SMike Waychison 	.sysfs_ops = &dmi_sysfs_attr_ops,
568948af1f0SMike Waychison 	.default_attrs = dmi_sysfs_entry_attrs,
569948af1f0SMike Waychison };
570948af1f0SMike Waychison 
571948af1f0SMike Waychison static struct kobject *dmi_kobj;
572948af1f0SMike Waychison static struct kset *dmi_kset;
573948af1f0SMike Waychison 
574948af1f0SMike Waychison /* Global count of all instances seen.  Only for setup */
575948af1f0SMike Waychison static int __initdata instance_counts[MAX_ENTRY_TYPE + 1];
576948af1f0SMike Waychison 
577948af1f0SMike Waychison /* Global positional count of all entries seen.  Only for setup */
578948af1f0SMike Waychison static int __initdata position_count;
579948af1f0SMike Waychison 
580948af1f0SMike Waychison static void __init dmi_sysfs_register_handle(const struct dmi_header *dh,
581948af1f0SMike Waychison 					     void *_ret)
582948af1f0SMike Waychison {
583948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry;
584948af1f0SMike Waychison 	int *ret = _ret;
585948af1f0SMike Waychison 
586948af1f0SMike Waychison 	/* If a previous entry saw an error, short circuit */
587948af1f0SMike Waychison 	if (*ret)
588948af1f0SMike Waychison 		return;
589948af1f0SMike Waychison 
590948af1f0SMike Waychison 	/* Allocate and register a new entry into the entries set */
591948af1f0SMike Waychison 	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
592948af1f0SMike Waychison 	if (!entry) {
593948af1f0SMike Waychison 		*ret = -ENOMEM;
594948af1f0SMike Waychison 		return;
595948af1f0SMike Waychison 	}
596948af1f0SMike Waychison 
597948af1f0SMike Waychison 	/* Set the key */
598948af1f0SMike Waychison 	entry->dh = *dh;
599948af1f0SMike Waychison 	entry->instance = instance_counts[dh->type]++;
600948af1f0SMike Waychison 	entry->position = position_count++;
601948af1f0SMike Waychison 
602948af1f0SMike Waychison 	entry->kobj.kset = dmi_kset;
603948af1f0SMike Waychison 	*ret = kobject_init_and_add(&entry->kobj, &dmi_sysfs_entry_ktype, NULL,
604948af1f0SMike Waychison 				    "%d-%d", dh->type, entry->instance);
605948af1f0SMike Waychison 
606948af1f0SMike Waychison 	if (*ret) {
607948af1f0SMike Waychison 		kfree(entry);
608948af1f0SMike Waychison 		return;
609948af1f0SMike Waychison 	}
610948af1f0SMike Waychison 
611948af1f0SMike Waychison 	/* Thread on the global list for cleanup */
612948af1f0SMike Waychison 	spin_lock(&entry_list_lock);
613948af1f0SMike Waychison 	list_add_tail(&entry->list, &entry_list);
614948af1f0SMike Waychison 	spin_unlock(&entry_list_lock);
615948af1f0SMike Waychison 
616925a1da7SMike Waychison 	/* Handle specializations by type */
617925a1da7SMike Waychison 	switch (dh->type) {
618925a1da7SMike Waychison 	case DMI_ENTRY_SYSTEM_EVENT_LOG:
619925a1da7SMike Waychison 		*ret = dmi_system_event_log(entry);
620925a1da7SMike Waychison 		break;
621925a1da7SMike Waychison 	default:
622925a1da7SMike Waychison 		/* No specialization */
623925a1da7SMike Waychison 		break;
624925a1da7SMike Waychison 	}
625925a1da7SMike Waychison 	if (*ret)
626925a1da7SMike Waychison 		goto out_err;
627925a1da7SMike Waychison 
628948af1f0SMike Waychison 	/* Create the raw binary file to access the entry */
629948af1f0SMike Waychison 	*ret = sysfs_create_bin_file(&entry->kobj, &dmi_entry_raw_attr);
630948af1f0SMike Waychison 	if (*ret)
631948af1f0SMike Waychison 		goto out_err;
632948af1f0SMike Waychison 
633948af1f0SMike Waychison 	return;
634948af1f0SMike Waychison out_err:
635925a1da7SMike Waychison 	kobject_put(entry->child);
636948af1f0SMike Waychison 	kobject_put(&entry->kobj);
637948af1f0SMike Waychison 	return;
638948af1f0SMike Waychison }
639948af1f0SMike Waychison 
640948af1f0SMike Waychison static void cleanup_entry_list(void)
641948af1f0SMike Waychison {
642948af1f0SMike Waychison 	struct dmi_sysfs_entry *entry, *next;
643948af1f0SMike Waychison 
644948af1f0SMike Waychison 	/* No locks, we are on our way out */
645948af1f0SMike Waychison 	list_for_each_entry_safe(entry, next, &entry_list, list) {
646925a1da7SMike Waychison 		kobject_put(entry->child);
647948af1f0SMike Waychison 		kobject_put(&entry->kobj);
648948af1f0SMike Waychison 	}
649948af1f0SMike Waychison }
650948af1f0SMike Waychison 
651948af1f0SMike Waychison static int __init dmi_sysfs_init(void)
652948af1f0SMike Waychison {
653948af1f0SMike Waychison 	int error = -ENOMEM;
654948af1f0SMike Waychison 	int val;
655948af1f0SMike Waychison 
656948af1f0SMike Waychison 	/* Set up our directory */
657948af1f0SMike Waychison 	dmi_kobj = kobject_create_and_add("dmi", firmware_kobj);
658948af1f0SMike Waychison 	if (!dmi_kobj)
659948af1f0SMike Waychison 		goto err;
660948af1f0SMike Waychison 
661948af1f0SMike Waychison 	dmi_kset = kset_create_and_add("entries", NULL, dmi_kobj);
662948af1f0SMike Waychison 	if (!dmi_kset)
663948af1f0SMike Waychison 		goto err;
664948af1f0SMike Waychison 
665948af1f0SMike Waychison 	val = 0;
666948af1f0SMike Waychison 	error = dmi_walk(dmi_sysfs_register_handle, &val);
667948af1f0SMike Waychison 	if (error)
668948af1f0SMike Waychison 		goto err;
669948af1f0SMike Waychison 	if (val) {
670948af1f0SMike Waychison 		error = val;
671948af1f0SMike Waychison 		goto err;
672948af1f0SMike Waychison 	}
673948af1f0SMike Waychison 
674948af1f0SMike Waychison 	pr_debug("dmi-sysfs: loaded.\n");
675948af1f0SMike Waychison 
676948af1f0SMike Waychison 	return 0;
677948af1f0SMike Waychison err:
678948af1f0SMike Waychison 	cleanup_entry_list();
679948af1f0SMike Waychison 	kset_unregister(dmi_kset);
680948af1f0SMike Waychison 	kobject_put(dmi_kobj);
681948af1f0SMike Waychison 	return error;
682948af1f0SMike Waychison }
683948af1f0SMike Waychison 
684948af1f0SMike Waychison /* clean up everything. */
685948af1f0SMike Waychison static void __exit dmi_sysfs_exit(void)
686948af1f0SMike Waychison {
687948af1f0SMike Waychison 	pr_debug("dmi-sysfs: unloading.\n");
688948af1f0SMike Waychison 	cleanup_entry_list();
689948af1f0SMike Waychison 	kset_unregister(dmi_kset);
690948af1f0SMike Waychison 	kobject_put(dmi_kobj);
691948af1f0SMike Waychison }
692948af1f0SMike Waychison 
693948af1f0SMike Waychison module_init(dmi_sysfs_init);
694948af1f0SMike Waychison module_exit(dmi_sysfs_exit);
695948af1f0SMike Waychison 
696948af1f0SMike Waychison MODULE_AUTHOR("Mike Waychison <mikew@google.com>");
697948af1f0SMike Waychison MODULE_DESCRIPTION("DMI sysfs support");
698948af1f0SMike Waychison MODULE_LICENSE("GPL");
699