162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * dmi-sysfs.c
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * This module exports the DMI tables read-only to userspace through the
662306a36Sopenharmony_ci * sysfs file system.
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Data is currently found below
962306a36Sopenharmony_ci *    /sys/firmware/dmi/...
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci * DMI attributes are presented in attribute files with names
1262306a36Sopenharmony_ci * formatted using %d-%d, so that the first integer indicates the
1362306a36Sopenharmony_ci * structure type (0-255), and the second field is the instance of that
1462306a36Sopenharmony_ci * entry.
1562306a36Sopenharmony_ci *
1662306a36Sopenharmony_ci * Copyright 2011 Google, Inc.
1762306a36Sopenharmony_ci */
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci#include <linux/kernel.h>
2062306a36Sopenharmony_ci#include <linux/init.h>
2162306a36Sopenharmony_ci#include <linux/module.h>
2262306a36Sopenharmony_ci#include <linux/types.h>
2362306a36Sopenharmony_ci#include <linux/kobject.h>
2462306a36Sopenharmony_ci#include <linux/dmi.h>
2562306a36Sopenharmony_ci#include <linux/capability.h>
2662306a36Sopenharmony_ci#include <linux/slab.h>
2762306a36Sopenharmony_ci#include <linux/list.h>
2862306a36Sopenharmony_ci#include <linux/io.h>
2962306a36Sopenharmony_ci#include <asm/dmi.h>
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#define MAX_ENTRY_TYPE 255 /* Most of these aren't used, but we consider
3262306a36Sopenharmony_ci			      the top entry type is only 8 bits */
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cistruct dmi_sysfs_entry {
3562306a36Sopenharmony_ci	struct dmi_header dh;
3662306a36Sopenharmony_ci	struct kobject kobj;
3762306a36Sopenharmony_ci	int instance;
3862306a36Sopenharmony_ci	int position;
3962306a36Sopenharmony_ci	struct list_head list;
4062306a36Sopenharmony_ci	struct kobject *child;
4162306a36Sopenharmony_ci};
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci/*
4462306a36Sopenharmony_ci * Global list of dmi_sysfs_entry.  Even though this should only be
4562306a36Sopenharmony_ci * manipulated at setup and teardown, the lazy nature of the kobject
4662306a36Sopenharmony_ci * system means we get lazy removes.
4762306a36Sopenharmony_ci */
4862306a36Sopenharmony_cistatic LIST_HEAD(entry_list);
4962306a36Sopenharmony_cistatic DEFINE_SPINLOCK(entry_list_lock);
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci/* dmi_sysfs_attribute - Top level attribute. used by all entries. */
5262306a36Sopenharmony_cistruct dmi_sysfs_attribute {
5362306a36Sopenharmony_ci	struct attribute attr;
5462306a36Sopenharmony_ci	ssize_t (*show)(struct dmi_sysfs_entry *entry, char *buf);
5562306a36Sopenharmony_ci};
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ci#define DMI_SYSFS_ATTR(_entry, _name) \
5862306a36Sopenharmony_cistruct dmi_sysfs_attribute dmi_sysfs_attr_##_entry##_##_name = { \
5962306a36Sopenharmony_ci	.attr = {.name = __stringify(_name), .mode = 0400}, \
6062306a36Sopenharmony_ci	.show = dmi_sysfs_##_entry##_##_name, \
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci/*
6462306a36Sopenharmony_ci * dmi_sysfs_mapped_attribute - Attribute where we require the entry be
6562306a36Sopenharmony_ci * mapped in.  Use in conjunction with dmi_sysfs_specialize_attr_ops.
6662306a36Sopenharmony_ci */
6762306a36Sopenharmony_cistruct dmi_sysfs_mapped_attribute {
6862306a36Sopenharmony_ci	struct attribute attr;
6962306a36Sopenharmony_ci	ssize_t (*show)(struct dmi_sysfs_entry *entry,
7062306a36Sopenharmony_ci			const struct dmi_header *dh,
7162306a36Sopenharmony_ci			char *buf);
7262306a36Sopenharmony_ci};
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci#define DMI_SYSFS_MAPPED_ATTR(_entry, _name) \
7562306a36Sopenharmony_cistruct dmi_sysfs_mapped_attribute dmi_sysfs_attr_##_entry##_##_name = { \
7662306a36Sopenharmony_ci	.attr = {.name = __stringify(_name), .mode = 0400}, \
7762306a36Sopenharmony_ci	.show = dmi_sysfs_##_entry##_##_name, \
7862306a36Sopenharmony_ci}
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci/*************************************************
8162306a36Sopenharmony_ci * Generic DMI entry support.
8262306a36Sopenharmony_ci *************************************************/
8362306a36Sopenharmony_cistatic void dmi_entry_free(struct kobject *kobj)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	kfree(kobj);
8662306a36Sopenharmony_ci}
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_cistatic struct dmi_sysfs_entry *to_entry(struct kobject *kobj)
8962306a36Sopenharmony_ci{
9062306a36Sopenharmony_ci	return container_of(kobj, struct dmi_sysfs_entry, kobj);
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_cistatic struct dmi_sysfs_attribute *to_attr(struct attribute *attr)
9462306a36Sopenharmony_ci{
9562306a36Sopenharmony_ci	return container_of(attr, struct dmi_sysfs_attribute, attr);
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic ssize_t dmi_sysfs_attr_show(struct kobject *kobj,
9962306a36Sopenharmony_ci				   struct attribute *_attr, char *buf)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry = to_entry(kobj);
10262306a36Sopenharmony_ci	struct dmi_sysfs_attribute *attr = to_attr(_attr);
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	/* DMI stuff is only ever admin visible */
10562306a36Sopenharmony_ci	if (!capable(CAP_SYS_ADMIN))
10662306a36Sopenharmony_ci		return -EACCES;
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	return attr->show(entry, buf);
10962306a36Sopenharmony_ci}
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_cistatic const struct sysfs_ops dmi_sysfs_attr_ops = {
11262306a36Sopenharmony_ci	.show = dmi_sysfs_attr_show,
11362306a36Sopenharmony_ci};
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_citypedef ssize_t (*dmi_callback)(struct dmi_sysfs_entry *,
11662306a36Sopenharmony_ci				const struct dmi_header *dh, void *);
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_cistruct find_dmi_data {
11962306a36Sopenharmony_ci	struct dmi_sysfs_entry	*entry;
12062306a36Sopenharmony_ci	dmi_callback		callback;
12162306a36Sopenharmony_ci	void			*private;
12262306a36Sopenharmony_ci	int			instance_countdown;
12362306a36Sopenharmony_ci	ssize_t			ret;
12462306a36Sopenharmony_ci};
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_cistatic void find_dmi_entry_helper(const struct dmi_header *dh,
12762306a36Sopenharmony_ci				  void *_data)
12862306a36Sopenharmony_ci{
12962306a36Sopenharmony_ci	struct find_dmi_data *data = _data;
13062306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry = data->entry;
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci	/* Is this the entry we want? */
13362306a36Sopenharmony_ci	if (dh->type != entry->dh.type)
13462306a36Sopenharmony_ci		return;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	if (data->instance_countdown != 0) {
13762306a36Sopenharmony_ci		/* try the next instance? */
13862306a36Sopenharmony_ci		data->instance_countdown--;
13962306a36Sopenharmony_ci		return;
14062306a36Sopenharmony_ci	}
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_ci	/*
14362306a36Sopenharmony_ci	 * Don't ever revisit the instance.  Short circuit later
14462306a36Sopenharmony_ci	 * instances by letting the instance_countdown run negative
14562306a36Sopenharmony_ci	 */
14662306a36Sopenharmony_ci	data->instance_countdown--;
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	/* Found the entry */
14962306a36Sopenharmony_ci	data->ret = data->callback(entry, dh, data->private);
15062306a36Sopenharmony_ci}
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci/* State for passing the read parameters through dmi_find_entry() */
15362306a36Sopenharmony_cistruct dmi_read_state {
15462306a36Sopenharmony_ci	char *buf;
15562306a36Sopenharmony_ci	loff_t pos;
15662306a36Sopenharmony_ci	size_t count;
15762306a36Sopenharmony_ci};
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_cistatic ssize_t find_dmi_entry(struct dmi_sysfs_entry *entry,
16062306a36Sopenharmony_ci			      dmi_callback callback, void *private)
16162306a36Sopenharmony_ci{
16262306a36Sopenharmony_ci	struct find_dmi_data data = {
16362306a36Sopenharmony_ci		.entry = entry,
16462306a36Sopenharmony_ci		.callback = callback,
16562306a36Sopenharmony_ci		.private = private,
16662306a36Sopenharmony_ci		.instance_countdown = entry->instance,
16762306a36Sopenharmony_ci		.ret = -EIO,  /* To signal the entry disappeared */
16862306a36Sopenharmony_ci	};
16962306a36Sopenharmony_ci	int ret;
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	ret = dmi_walk(find_dmi_entry_helper, &data);
17262306a36Sopenharmony_ci	/* This shouldn't happen, but just in case. */
17362306a36Sopenharmony_ci	if (ret)
17462306a36Sopenharmony_ci		return -EINVAL;
17562306a36Sopenharmony_ci	return data.ret;
17662306a36Sopenharmony_ci}
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci/*
17962306a36Sopenharmony_ci * Calculate and return the byte length of the dmi entry identified by
18062306a36Sopenharmony_ci * dh.  This includes both the formatted portion as well as the
18162306a36Sopenharmony_ci * unformatted string space, including the two trailing nul characters.
18262306a36Sopenharmony_ci */
18362306a36Sopenharmony_cistatic size_t dmi_entry_length(const struct dmi_header *dh)
18462306a36Sopenharmony_ci{
18562306a36Sopenharmony_ci	const char *p = (const char *)dh;
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	p += dh->length;
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_ci	while (p[0] || p[1])
19062306a36Sopenharmony_ci		p++;
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	return 2 + p - (const char *)dh;
19362306a36Sopenharmony_ci}
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci/*************************************************
19662306a36Sopenharmony_ci * Support bits for specialized DMI entry support
19762306a36Sopenharmony_ci *************************************************/
19862306a36Sopenharmony_cistruct dmi_entry_attr_show_data {
19962306a36Sopenharmony_ci	struct attribute *attr;
20062306a36Sopenharmony_ci	char *buf;
20162306a36Sopenharmony_ci};
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_cistatic ssize_t dmi_entry_attr_show_helper(struct dmi_sysfs_entry *entry,
20462306a36Sopenharmony_ci					  const struct dmi_header *dh,
20562306a36Sopenharmony_ci					  void *_data)
20662306a36Sopenharmony_ci{
20762306a36Sopenharmony_ci	struct dmi_entry_attr_show_data *data = _data;
20862306a36Sopenharmony_ci	struct dmi_sysfs_mapped_attribute *attr;
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	attr = container_of(data->attr,
21162306a36Sopenharmony_ci			    struct dmi_sysfs_mapped_attribute, attr);
21262306a36Sopenharmony_ci	return attr->show(entry, dh, data->buf);
21362306a36Sopenharmony_ci}
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_cistatic ssize_t dmi_entry_attr_show(struct kobject *kobj,
21662306a36Sopenharmony_ci				   struct attribute *attr,
21762306a36Sopenharmony_ci				   char *buf)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	struct dmi_entry_attr_show_data data = {
22062306a36Sopenharmony_ci		.attr = attr,
22162306a36Sopenharmony_ci		.buf  = buf,
22262306a36Sopenharmony_ci	};
22362306a36Sopenharmony_ci	/* Find the entry according to our parent and call the
22462306a36Sopenharmony_ci	 * normalized show method hanging off of the attribute */
22562306a36Sopenharmony_ci	return find_dmi_entry(to_entry(kobj->parent),
22662306a36Sopenharmony_ci			      dmi_entry_attr_show_helper, &data);
22762306a36Sopenharmony_ci}
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_cistatic const struct sysfs_ops dmi_sysfs_specialize_attr_ops = {
23062306a36Sopenharmony_ci	.show = dmi_entry_attr_show,
23162306a36Sopenharmony_ci};
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci/*************************************************
23462306a36Sopenharmony_ci * Specialized DMI entry support.
23562306a36Sopenharmony_ci *************************************************/
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci/*** Type 15 - System Event Table ***/
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci#define DMI_SEL_ACCESS_METHOD_IO8	0x00
24062306a36Sopenharmony_ci#define DMI_SEL_ACCESS_METHOD_IO2x8	0x01
24162306a36Sopenharmony_ci#define DMI_SEL_ACCESS_METHOD_IO16	0x02
24262306a36Sopenharmony_ci#define DMI_SEL_ACCESS_METHOD_PHYS32	0x03
24362306a36Sopenharmony_ci#define DMI_SEL_ACCESS_METHOD_GPNV	0x04
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_cistruct dmi_system_event_log {
24662306a36Sopenharmony_ci	struct dmi_header header;
24762306a36Sopenharmony_ci	u16	area_length;
24862306a36Sopenharmony_ci	u16	header_start_offset;
24962306a36Sopenharmony_ci	u16	data_start_offset;
25062306a36Sopenharmony_ci	u8	access_method;
25162306a36Sopenharmony_ci	u8	status;
25262306a36Sopenharmony_ci	u32	change_token;
25362306a36Sopenharmony_ci	union {
25462306a36Sopenharmony_ci		struct {
25562306a36Sopenharmony_ci			u16 index_addr;
25662306a36Sopenharmony_ci			u16 data_addr;
25762306a36Sopenharmony_ci		} io;
25862306a36Sopenharmony_ci		u32	phys_addr32;
25962306a36Sopenharmony_ci		u16	gpnv_handle;
26062306a36Sopenharmony_ci		u32	access_method_address;
26162306a36Sopenharmony_ci	};
26262306a36Sopenharmony_ci	u8	header_format;
26362306a36Sopenharmony_ci	u8	type_descriptors_supported_count;
26462306a36Sopenharmony_ci	u8	per_log_type_descriptor_length;
26562306a36Sopenharmony_ci	u8	supported_log_type_descriptos[];
26662306a36Sopenharmony_ci} __packed;
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci#define DMI_SYSFS_SEL_FIELD(_field) \
26962306a36Sopenharmony_cistatic ssize_t dmi_sysfs_sel_##_field(struct dmi_sysfs_entry *entry, \
27062306a36Sopenharmony_ci				      const struct dmi_header *dh, \
27162306a36Sopenharmony_ci				      char *buf) \
27262306a36Sopenharmony_ci{ \
27362306a36Sopenharmony_ci	struct dmi_system_event_log sel; \
27462306a36Sopenharmony_ci	if (sizeof(sel) > dmi_entry_length(dh)) \
27562306a36Sopenharmony_ci		return -EIO; \
27662306a36Sopenharmony_ci	memcpy(&sel, dh, sizeof(sel)); \
27762306a36Sopenharmony_ci	return sprintf(buf, "%u\n", sel._field); \
27862306a36Sopenharmony_ci} \
27962306a36Sopenharmony_cistatic DMI_SYSFS_MAPPED_ATTR(sel, _field)
28062306a36Sopenharmony_ci
28162306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(area_length);
28262306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(header_start_offset);
28362306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(data_start_offset);
28462306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(access_method);
28562306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(status);
28662306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(change_token);
28762306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(access_method_address);
28862306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(header_format);
28962306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(type_descriptors_supported_count);
29062306a36Sopenharmony_ciDMI_SYSFS_SEL_FIELD(per_log_type_descriptor_length);
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_cistatic struct attribute *dmi_sysfs_sel_attrs[] = {
29362306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_area_length.attr,
29462306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_header_start_offset.attr,
29562306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_data_start_offset.attr,
29662306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_access_method.attr,
29762306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_status.attr,
29862306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_change_token.attr,
29962306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_access_method_address.attr,
30062306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_header_format.attr,
30162306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_type_descriptors_supported_count.attr,
30262306a36Sopenharmony_ci	&dmi_sysfs_attr_sel_per_log_type_descriptor_length.attr,
30362306a36Sopenharmony_ci	NULL,
30462306a36Sopenharmony_ci};
30562306a36Sopenharmony_ciATTRIBUTE_GROUPS(dmi_sysfs_sel);
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_cistatic const struct kobj_type dmi_system_event_log_ktype = {
30862306a36Sopenharmony_ci	.release = dmi_entry_free,
30962306a36Sopenharmony_ci	.sysfs_ops = &dmi_sysfs_specialize_attr_ops,
31062306a36Sopenharmony_ci	.default_groups = dmi_sysfs_sel_groups,
31162306a36Sopenharmony_ci};
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ci#ifdef CONFIG_HAS_IOPORT
31462306a36Sopenharmony_citypedef u8 (*sel_io_reader)(const struct dmi_system_event_log *sel,
31562306a36Sopenharmony_ci			    loff_t offset);
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_cistatic DEFINE_MUTEX(io_port_lock);
31862306a36Sopenharmony_ci
31962306a36Sopenharmony_cistatic u8 read_sel_8bit_indexed_io(const struct dmi_system_event_log *sel,
32062306a36Sopenharmony_ci				   loff_t offset)
32162306a36Sopenharmony_ci{
32262306a36Sopenharmony_ci	u8 ret;
32362306a36Sopenharmony_ci
32462306a36Sopenharmony_ci	mutex_lock(&io_port_lock);
32562306a36Sopenharmony_ci	outb((u8)offset, sel->io.index_addr);
32662306a36Sopenharmony_ci	ret = inb(sel->io.data_addr);
32762306a36Sopenharmony_ci	mutex_unlock(&io_port_lock);
32862306a36Sopenharmony_ci	return ret;
32962306a36Sopenharmony_ci}
33062306a36Sopenharmony_ci
33162306a36Sopenharmony_cistatic u8 read_sel_2x8bit_indexed_io(const struct dmi_system_event_log *sel,
33262306a36Sopenharmony_ci				     loff_t offset)
33362306a36Sopenharmony_ci{
33462306a36Sopenharmony_ci	u8 ret;
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_ci	mutex_lock(&io_port_lock);
33762306a36Sopenharmony_ci	outb((u8)offset, sel->io.index_addr);
33862306a36Sopenharmony_ci	outb((u8)(offset >> 8), sel->io.index_addr + 1);
33962306a36Sopenharmony_ci	ret = inb(sel->io.data_addr);
34062306a36Sopenharmony_ci	mutex_unlock(&io_port_lock);
34162306a36Sopenharmony_ci	return ret;
34262306a36Sopenharmony_ci}
34362306a36Sopenharmony_ci
34462306a36Sopenharmony_cistatic u8 read_sel_16bit_indexed_io(const struct dmi_system_event_log *sel,
34562306a36Sopenharmony_ci				    loff_t offset)
34662306a36Sopenharmony_ci{
34762306a36Sopenharmony_ci	u8 ret;
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci	mutex_lock(&io_port_lock);
35062306a36Sopenharmony_ci	outw((u16)offset, sel->io.index_addr);
35162306a36Sopenharmony_ci	ret = inb(sel->io.data_addr);
35262306a36Sopenharmony_ci	mutex_unlock(&io_port_lock);
35362306a36Sopenharmony_ci	return ret;
35462306a36Sopenharmony_ci}
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_cistatic sel_io_reader sel_io_readers[] = {
35762306a36Sopenharmony_ci	[DMI_SEL_ACCESS_METHOD_IO8]	= read_sel_8bit_indexed_io,
35862306a36Sopenharmony_ci	[DMI_SEL_ACCESS_METHOD_IO2x8]	= read_sel_2x8bit_indexed_io,
35962306a36Sopenharmony_ci	[DMI_SEL_ACCESS_METHOD_IO16]	= read_sel_16bit_indexed_io,
36062306a36Sopenharmony_ci};
36162306a36Sopenharmony_ci
36262306a36Sopenharmony_cistatic ssize_t dmi_sel_raw_read_io(struct dmi_sysfs_entry *entry,
36362306a36Sopenharmony_ci				   const struct dmi_system_event_log *sel,
36462306a36Sopenharmony_ci				   char *buf, loff_t pos, size_t count)
36562306a36Sopenharmony_ci{
36662306a36Sopenharmony_ci	ssize_t wrote = 0;
36762306a36Sopenharmony_ci
36862306a36Sopenharmony_ci	sel_io_reader io_reader = sel_io_readers[sel->access_method];
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci	while (count && pos < sel->area_length) {
37162306a36Sopenharmony_ci		count--;
37262306a36Sopenharmony_ci		*(buf++) = io_reader(sel, pos++);
37362306a36Sopenharmony_ci		wrote++;
37462306a36Sopenharmony_ci	}
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_ci	return wrote;
37762306a36Sopenharmony_ci}
37862306a36Sopenharmony_ci#endif
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_cistatic ssize_t dmi_sel_raw_read_phys32(struct dmi_sysfs_entry *entry,
38162306a36Sopenharmony_ci				       const struct dmi_system_event_log *sel,
38262306a36Sopenharmony_ci				       char *buf, loff_t pos, size_t count)
38362306a36Sopenharmony_ci{
38462306a36Sopenharmony_ci	u8 __iomem *mapped;
38562306a36Sopenharmony_ci	ssize_t wrote = 0;
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci	mapped = dmi_remap(sel->access_method_address, sel->area_length);
38862306a36Sopenharmony_ci	if (!mapped)
38962306a36Sopenharmony_ci		return -EIO;
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_ci	while (count && pos < sel->area_length) {
39262306a36Sopenharmony_ci		count--;
39362306a36Sopenharmony_ci		*(buf++) = readb(mapped + pos++);
39462306a36Sopenharmony_ci		wrote++;
39562306a36Sopenharmony_ci	}
39662306a36Sopenharmony_ci
39762306a36Sopenharmony_ci	dmi_unmap(mapped);
39862306a36Sopenharmony_ci	return wrote;
39962306a36Sopenharmony_ci}
40062306a36Sopenharmony_ci
40162306a36Sopenharmony_cistatic ssize_t dmi_sel_raw_read_helper(struct dmi_sysfs_entry *entry,
40262306a36Sopenharmony_ci				       const struct dmi_header *dh,
40362306a36Sopenharmony_ci				       void *_state)
40462306a36Sopenharmony_ci{
40562306a36Sopenharmony_ci	struct dmi_read_state *state = _state;
40662306a36Sopenharmony_ci	struct dmi_system_event_log sel;
40762306a36Sopenharmony_ci
40862306a36Sopenharmony_ci	if (sizeof(sel) > dmi_entry_length(dh))
40962306a36Sopenharmony_ci		return -EIO;
41062306a36Sopenharmony_ci
41162306a36Sopenharmony_ci	memcpy(&sel, dh, sizeof(sel));
41262306a36Sopenharmony_ci
41362306a36Sopenharmony_ci	switch (sel.access_method) {
41462306a36Sopenharmony_ci#ifdef CONFIG_HAS_IOPORT
41562306a36Sopenharmony_ci	case DMI_SEL_ACCESS_METHOD_IO8:
41662306a36Sopenharmony_ci	case DMI_SEL_ACCESS_METHOD_IO2x8:
41762306a36Sopenharmony_ci	case DMI_SEL_ACCESS_METHOD_IO16:
41862306a36Sopenharmony_ci		return dmi_sel_raw_read_io(entry, &sel, state->buf,
41962306a36Sopenharmony_ci					   state->pos, state->count);
42062306a36Sopenharmony_ci#endif
42162306a36Sopenharmony_ci	case DMI_SEL_ACCESS_METHOD_PHYS32:
42262306a36Sopenharmony_ci		return dmi_sel_raw_read_phys32(entry, &sel, state->buf,
42362306a36Sopenharmony_ci					       state->pos, state->count);
42462306a36Sopenharmony_ci	case DMI_SEL_ACCESS_METHOD_GPNV:
42562306a36Sopenharmony_ci		pr_info_ratelimited("dmi-sysfs: GPNV support missing.\n");
42662306a36Sopenharmony_ci		return -EIO;
42762306a36Sopenharmony_ci	default:
42862306a36Sopenharmony_ci		pr_info_ratelimited("dmi-sysfs: Unknown access method %02x\n",
42962306a36Sopenharmony_ci			sel.access_method);
43062306a36Sopenharmony_ci		return -EIO;
43162306a36Sopenharmony_ci	}
43262306a36Sopenharmony_ci}
43362306a36Sopenharmony_ci
43462306a36Sopenharmony_cistatic ssize_t dmi_sel_raw_read(struct file *filp, struct kobject *kobj,
43562306a36Sopenharmony_ci				struct bin_attribute *bin_attr,
43662306a36Sopenharmony_ci				char *buf, loff_t pos, size_t count)
43762306a36Sopenharmony_ci{
43862306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry = to_entry(kobj->parent);
43962306a36Sopenharmony_ci	struct dmi_read_state state = {
44062306a36Sopenharmony_ci		.buf = buf,
44162306a36Sopenharmony_ci		.pos = pos,
44262306a36Sopenharmony_ci		.count = count,
44362306a36Sopenharmony_ci	};
44462306a36Sopenharmony_ci
44562306a36Sopenharmony_ci	return find_dmi_entry(entry, dmi_sel_raw_read_helper, &state);
44662306a36Sopenharmony_ci}
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_cistatic struct bin_attribute dmi_sel_raw_attr = {
44962306a36Sopenharmony_ci	.attr = {.name = "raw_event_log", .mode = 0400},
45062306a36Sopenharmony_ci	.read = dmi_sel_raw_read,
45162306a36Sopenharmony_ci};
45262306a36Sopenharmony_ci
45362306a36Sopenharmony_cistatic int dmi_system_event_log(struct dmi_sysfs_entry *entry)
45462306a36Sopenharmony_ci{
45562306a36Sopenharmony_ci	int ret;
45662306a36Sopenharmony_ci
45762306a36Sopenharmony_ci	entry->child = kzalloc(sizeof(*entry->child), GFP_KERNEL);
45862306a36Sopenharmony_ci	if (!entry->child)
45962306a36Sopenharmony_ci		return -ENOMEM;
46062306a36Sopenharmony_ci	ret = kobject_init_and_add(entry->child,
46162306a36Sopenharmony_ci				   &dmi_system_event_log_ktype,
46262306a36Sopenharmony_ci				   &entry->kobj,
46362306a36Sopenharmony_ci				   "system_event_log");
46462306a36Sopenharmony_ci	if (ret)
46562306a36Sopenharmony_ci		goto out_free;
46662306a36Sopenharmony_ci
46762306a36Sopenharmony_ci	ret = sysfs_create_bin_file(entry->child, &dmi_sel_raw_attr);
46862306a36Sopenharmony_ci	if (ret)
46962306a36Sopenharmony_ci		goto out_del;
47062306a36Sopenharmony_ci
47162306a36Sopenharmony_ci	return 0;
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_ciout_del:
47462306a36Sopenharmony_ci	kobject_del(entry->child);
47562306a36Sopenharmony_ciout_free:
47662306a36Sopenharmony_ci	kfree(entry->child);
47762306a36Sopenharmony_ci	return ret;
47862306a36Sopenharmony_ci}
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_ci/*************************************************
48162306a36Sopenharmony_ci * Generic DMI entry support.
48262306a36Sopenharmony_ci *************************************************/
48362306a36Sopenharmony_ci
48462306a36Sopenharmony_cistatic ssize_t dmi_sysfs_entry_length(struct dmi_sysfs_entry *entry, char *buf)
48562306a36Sopenharmony_ci{
48662306a36Sopenharmony_ci	return sprintf(buf, "%d\n", entry->dh.length);
48762306a36Sopenharmony_ci}
48862306a36Sopenharmony_ci
48962306a36Sopenharmony_cistatic ssize_t dmi_sysfs_entry_handle(struct dmi_sysfs_entry *entry, char *buf)
49062306a36Sopenharmony_ci{
49162306a36Sopenharmony_ci	return sprintf(buf, "%d\n", entry->dh.handle);
49262306a36Sopenharmony_ci}
49362306a36Sopenharmony_ci
49462306a36Sopenharmony_cistatic ssize_t dmi_sysfs_entry_type(struct dmi_sysfs_entry *entry, char *buf)
49562306a36Sopenharmony_ci{
49662306a36Sopenharmony_ci	return sprintf(buf, "%d\n", entry->dh.type);
49762306a36Sopenharmony_ci}
49862306a36Sopenharmony_ci
49962306a36Sopenharmony_cistatic ssize_t dmi_sysfs_entry_instance(struct dmi_sysfs_entry *entry,
50062306a36Sopenharmony_ci					char *buf)
50162306a36Sopenharmony_ci{
50262306a36Sopenharmony_ci	return sprintf(buf, "%d\n", entry->instance);
50362306a36Sopenharmony_ci}
50462306a36Sopenharmony_ci
50562306a36Sopenharmony_cistatic ssize_t dmi_sysfs_entry_position(struct dmi_sysfs_entry *entry,
50662306a36Sopenharmony_ci					char *buf)
50762306a36Sopenharmony_ci{
50862306a36Sopenharmony_ci	return sprintf(buf, "%d\n", entry->position);
50962306a36Sopenharmony_ci}
51062306a36Sopenharmony_ci
51162306a36Sopenharmony_cistatic DMI_SYSFS_ATTR(entry, length);
51262306a36Sopenharmony_cistatic DMI_SYSFS_ATTR(entry, handle);
51362306a36Sopenharmony_cistatic DMI_SYSFS_ATTR(entry, type);
51462306a36Sopenharmony_cistatic DMI_SYSFS_ATTR(entry, instance);
51562306a36Sopenharmony_cistatic DMI_SYSFS_ATTR(entry, position);
51662306a36Sopenharmony_ci
51762306a36Sopenharmony_cistatic struct attribute *dmi_sysfs_entry_attrs[] = {
51862306a36Sopenharmony_ci	&dmi_sysfs_attr_entry_length.attr,
51962306a36Sopenharmony_ci	&dmi_sysfs_attr_entry_handle.attr,
52062306a36Sopenharmony_ci	&dmi_sysfs_attr_entry_type.attr,
52162306a36Sopenharmony_ci	&dmi_sysfs_attr_entry_instance.attr,
52262306a36Sopenharmony_ci	&dmi_sysfs_attr_entry_position.attr,
52362306a36Sopenharmony_ci	NULL,
52462306a36Sopenharmony_ci};
52562306a36Sopenharmony_ciATTRIBUTE_GROUPS(dmi_sysfs_entry);
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_cistatic ssize_t dmi_entry_raw_read_helper(struct dmi_sysfs_entry *entry,
52862306a36Sopenharmony_ci					 const struct dmi_header *dh,
52962306a36Sopenharmony_ci					 void *_state)
53062306a36Sopenharmony_ci{
53162306a36Sopenharmony_ci	struct dmi_read_state *state = _state;
53262306a36Sopenharmony_ci	size_t entry_length;
53362306a36Sopenharmony_ci
53462306a36Sopenharmony_ci	entry_length = dmi_entry_length(dh);
53562306a36Sopenharmony_ci
53662306a36Sopenharmony_ci	return memory_read_from_buffer(state->buf, state->count,
53762306a36Sopenharmony_ci				       &state->pos, dh, entry_length);
53862306a36Sopenharmony_ci}
53962306a36Sopenharmony_ci
54062306a36Sopenharmony_cistatic ssize_t dmi_entry_raw_read(struct file *filp,
54162306a36Sopenharmony_ci				  struct kobject *kobj,
54262306a36Sopenharmony_ci				  struct bin_attribute *bin_attr,
54362306a36Sopenharmony_ci				  char *buf, loff_t pos, size_t count)
54462306a36Sopenharmony_ci{
54562306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry = to_entry(kobj);
54662306a36Sopenharmony_ci	struct dmi_read_state state = {
54762306a36Sopenharmony_ci		.buf = buf,
54862306a36Sopenharmony_ci		.pos = pos,
54962306a36Sopenharmony_ci		.count = count,
55062306a36Sopenharmony_ci	};
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	return find_dmi_entry(entry, dmi_entry_raw_read_helper, &state);
55362306a36Sopenharmony_ci}
55462306a36Sopenharmony_ci
55562306a36Sopenharmony_cistatic const struct bin_attribute dmi_entry_raw_attr = {
55662306a36Sopenharmony_ci	.attr = {.name = "raw", .mode = 0400},
55762306a36Sopenharmony_ci	.read = dmi_entry_raw_read,
55862306a36Sopenharmony_ci};
55962306a36Sopenharmony_ci
56062306a36Sopenharmony_cistatic void dmi_sysfs_entry_release(struct kobject *kobj)
56162306a36Sopenharmony_ci{
56262306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry = to_entry(kobj);
56362306a36Sopenharmony_ci
56462306a36Sopenharmony_ci	spin_lock(&entry_list_lock);
56562306a36Sopenharmony_ci	list_del(&entry->list);
56662306a36Sopenharmony_ci	spin_unlock(&entry_list_lock);
56762306a36Sopenharmony_ci	kfree(entry);
56862306a36Sopenharmony_ci}
56962306a36Sopenharmony_ci
57062306a36Sopenharmony_cistatic const struct kobj_type dmi_sysfs_entry_ktype = {
57162306a36Sopenharmony_ci	.release = dmi_sysfs_entry_release,
57262306a36Sopenharmony_ci	.sysfs_ops = &dmi_sysfs_attr_ops,
57362306a36Sopenharmony_ci	.default_groups = dmi_sysfs_entry_groups,
57462306a36Sopenharmony_ci};
57562306a36Sopenharmony_ci
57662306a36Sopenharmony_cistatic struct kset *dmi_kset;
57762306a36Sopenharmony_ci
57862306a36Sopenharmony_ci/* Global count of all instances seen.  Only for setup */
57962306a36Sopenharmony_cistatic int __initdata instance_counts[MAX_ENTRY_TYPE + 1];
58062306a36Sopenharmony_ci
58162306a36Sopenharmony_ci/* Global positional count of all entries seen.  Only for setup */
58262306a36Sopenharmony_cistatic int __initdata position_count;
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_cistatic void __init dmi_sysfs_register_handle(const struct dmi_header *dh,
58562306a36Sopenharmony_ci					     void *_ret)
58662306a36Sopenharmony_ci{
58762306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry;
58862306a36Sopenharmony_ci	int *ret = _ret;
58962306a36Sopenharmony_ci
59062306a36Sopenharmony_ci	/* If a previous entry saw an error, short circuit */
59162306a36Sopenharmony_ci	if (*ret)
59262306a36Sopenharmony_ci		return;
59362306a36Sopenharmony_ci
59462306a36Sopenharmony_ci	/* Allocate and register a new entry into the entries set */
59562306a36Sopenharmony_ci	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
59662306a36Sopenharmony_ci	if (!entry) {
59762306a36Sopenharmony_ci		*ret = -ENOMEM;
59862306a36Sopenharmony_ci		return;
59962306a36Sopenharmony_ci	}
60062306a36Sopenharmony_ci
60162306a36Sopenharmony_ci	/* Set the key */
60262306a36Sopenharmony_ci	memcpy(&entry->dh, dh, sizeof(*dh));
60362306a36Sopenharmony_ci	entry->instance = instance_counts[dh->type]++;
60462306a36Sopenharmony_ci	entry->position = position_count++;
60562306a36Sopenharmony_ci
60662306a36Sopenharmony_ci	entry->kobj.kset = dmi_kset;
60762306a36Sopenharmony_ci	*ret = kobject_init_and_add(&entry->kobj, &dmi_sysfs_entry_ktype, NULL,
60862306a36Sopenharmony_ci				    "%d-%d", dh->type, entry->instance);
60962306a36Sopenharmony_ci
61062306a36Sopenharmony_ci	/* Thread on the global list for cleanup */
61162306a36Sopenharmony_ci	spin_lock(&entry_list_lock);
61262306a36Sopenharmony_ci	list_add_tail(&entry->list, &entry_list);
61362306a36Sopenharmony_ci	spin_unlock(&entry_list_lock);
61462306a36Sopenharmony_ci
61562306a36Sopenharmony_ci	if (*ret) {
61662306a36Sopenharmony_ci		kobject_put(&entry->kobj);
61762306a36Sopenharmony_ci		return;
61862306a36Sopenharmony_ci	}
61962306a36Sopenharmony_ci
62062306a36Sopenharmony_ci	/* Handle specializations by type */
62162306a36Sopenharmony_ci	switch (dh->type) {
62262306a36Sopenharmony_ci	case DMI_ENTRY_SYSTEM_EVENT_LOG:
62362306a36Sopenharmony_ci		*ret = dmi_system_event_log(entry);
62462306a36Sopenharmony_ci		break;
62562306a36Sopenharmony_ci	default:
62662306a36Sopenharmony_ci		/* No specialization */
62762306a36Sopenharmony_ci		break;
62862306a36Sopenharmony_ci	}
62962306a36Sopenharmony_ci	if (*ret)
63062306a36Sopenharmony_ci		goto out_err;
63162306a36Sopenharmony_ci
63262306a36Sopenharmony_ci	/* Create the raw binary file to access the entry */
63362306a36Sopenharmony_ci	*ret = sysfs_create_bin_file(&entry->kobj, &dmi_entry_raw_attr);
63462306a36Sopenharmony_ci	if (*ret)
63562306a36Sopenharmony_ci		goto out_err;
63662306a36Sopenharmony_ci
63762306a36Sopenharmony_ci	return;
63862306a36Sopenharmony_ciout_err:
63962306a36Sopenharmony_ci	kobject_put(entry->child);
64062306a36Sopenharmony_ci	kobject_put(&entry->kobj);
64162306a36Sopenharmony_ci	return;
64262306a36Sopenharmony_ci}
64362306a36Sopenharmony_ci
64462306a36Sopenharmony_cistatic void cleanup_entry_list(void)
64562306a36Sopenharmony_ci{
64662306a36Sopenharmony_ci	struct dmi_sysfs_entry *entry, *next;
64762306a36Sopenharmony_ci
64862306a36Sopenharmony_ci	/* No locks, we are on our way out */
64962306a36Sopenharmony_ci	list_for_each_entry_safe(entry, next, &entry_list, list) {
65062306a36Sopenharmony_ci		kobject_put(entry->child);
65162306a36Sopenharmony_ci		kobject_put(&entry->kobj);
65262306a36Sopenharmony_ci	}
65362306a36Sopenharmony_ci}
65462306a36Sopenharmony_ci
65562306a36Sopenharmony_cistatic int __init dmi_sysfs_init(void)
65662306a36Sopenharmony_ci{
65762306a36Sopenharmony_ci	int error;
65862306a36Sopenharmony_ci	int val;
65962306a36Sopenharmony_ci
66062306a36Sopenharmony_ci	if (!dmi_kobj) {
66162306a36Sopenharmony_ci		pr_debug("dmi-sysfs: dmi entry is absent.\n");
66262306a36Sopenharmony_ci		error = -ENODATA;
66362306a36Sopenharmony_ci		goto err;
66462306a36Sopenharmony_ci	}
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci	dmi_kset = kset_create_and_add("entries", NULL, dmi_kobj);
66762306a36Sopenharmony_ci	if (!dmi_kset) {
66862306a36Sopenharmony_ci		error = -ENOMEM;
66962306a36Sopenharmony_ci		goto err;
67062306a36Sopenharmony_ci	}
67162306a36Sopenharmony_ci
67262306a36Sopenharmony_ci	val = 0;
67362306a36Sopenharmony_ci	error = dmi_walk(dmi_sysfs_register_handle, &val);
67462306a36Sopenharmony_ci	if (error)
67562306a36Sopenharmony_ci		goto err;
67662306a36Sopenharmony_ci	if (val) {
67762306a36Sopenharmony_ci		error = val;
67862306a36Sopenharmony_ci		goto err;
67962306a36Sopenharmony_ci	}
68062306a36Sopenharmony_ci
68162306a36Sopenharmony_ci	pr_debug("dmi-sysfs: loaded.\n");
68262306a36Sopenharmony_ci
68362306a36Sopenharmony_ci	return 0;
68462306a36Sopenharmony_cierr:
68562306a36Sopenharmony_ci	cleanup_entry_list();
68662306a36Sopenharmony_ci	kset_unregister(dmi_kset);
68762306a36Sopenharmony_ci	return error;
68862306a36Sopenharmony_ci}
68962306a36Sopenharmony_ci
69062306a36Sopenharmony_ci/* clean up everything. */
69162306a36Sopenharmony_cistatic void __exit dmi_sysfs_exit(void)
69262306a36Sopenharmony_ci{
69362306a36Sopenharmony_ci	pr_debug("dmi-sysfs: unloading.\n");
69462306a36Sopenharmony_ci	cleanup_entry_list();
69562306a36Sopenharmony_ci	kset_unregister(dmi_kset);
69662306a36Sopenharmony_ci}
69762306a36Sopenharmony_ci
69862306a36Sopenharmony_cimodule_init(dmi_sysfs_init);
69962306a36Sopenharmony_cimodule_exit(dmi_sysfs_exit);
70062306a36Sopenharmony_ci
70162306a36Sopenharmony_ciMODULE_AUTHOR("Mike Waychison <mikew@google.com>");
70262306a36Sopenharmony_ciMODULE_DESCRIPTION("DMI sysfs support");
70362306a36Sopenharmony_ciMODULE_LICENSE("GPL");
704