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