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 315*a3857a5cSMike Waychison typedef u8 (*sel_io_reader)(const struct dmi_system_event_log *sel, 316*a3857a5cSMike Waychison loff_t offset); 317*a3857a5cSMike Waychison 318*a3857a5cSMike Waychison static DEFINE_MUTEX(io_port_lock); 319*a3857a5cSMike Waychison 320*a3857a5cSMike Waychison static u8 read_sel_8bit_indexed_io(const struct dmi_system_event_log *sel, 321*a3857a5cSMike Waychison loff_t offset) 322*a3857a5cSMike Waychison { 323*a3857a5cSMike Waychison u8 ret; 324*a3857a5cSMike Waychison 325*a3857a5cSMike Waychison mutex_lock(&io_port_lock); 326*a3857a5cSMike Waychison outb((u8)offset, sel->io.index_addr); 327*a3857a5cSMike Waychison ret = inb(sel->io.data_addr); 328*a3857a5cSMike Waychison mutex_unlock(&io_port_lock); 329*a3857a5cSMike Waychison return ret; 330*a3857a5cSMike Waychison } 331*a3857a5cSMike Waychison 332*a3857a5cSMike Waychison static u8 read_sel_2x8bit_indexed_io(const struct dmi_system_event_log *sel, 333*a3857a5cSMike Waychison loff_t offset) 334*a3857a5cSMike Waychison { 335*a3857a5cSMike Waychison u8 ret; 336*a3857a5cSMike Waychison 337*a3857a5cSMike Waychison mutex_lock(&io_port_lock); 338*a3857a5cSMike Waychison outb((u8)offset, sel->io.index_addr); 339*a3857a5cSMike Waychison outb((u8)(offset >> 8), sel->io.index_addr + 1); 340*a3857a5cSMike Waychison ret = inb(sel->io.data_addr); 341*a3857a5cSMike Waychison mutex_unlock(&io_port_lock); 342*a3857a5cSMike Waychison return ret; 343*a3857a5cSMike Waychison } 344*a3857a5cSMike Waychison 345*a3857a5cSMike Waychison static u8 read_sel_16bit_indexed_io(const struct dmi_system_event_log *sel, 346*a3857a5cSMike Waychison loff_t offset) 347*a3857a5cSMike Waychison { 348*a3857a5cSMike Waychison u8 ret; 349*a3857a5cSMike Waychison 350*a3857a5cSMike Waychison mutex_lock(&io_port_lock); 351*a3857a5cSMike Waychison outw((u16)offset, sel->io.index_addr); 352*a3857a5cSMike Waychison ret = inb(sel->io.data_addr); 353*a3857a5cSMike Waychison mutex_unlock(&io_port_lock); 354*a3857a5cSMike Waychison return ret; 355*a3857a5cSMike Waychison } 356*a3857a5cSMike Waychison 357*a3857a5cSMike Waychison static sel_io_reader sel_io_readers[] = { 358*a3857a5cSMike Waychison [DMI_SEL_ACCESS_METHOD_IO8] = read_sel_8bit_indexed_io, 359*a3857a5cSMike Waychison [DMI_SEL_ACCESS_METHOD_IO2x8] = read_sel_2x8bit_indexed_io, 360*a3857a5cSMike Waychison [DMI_SEL_ACCESS_METHOD_IO16] = read_sel_16bit_indexed_io, 361*a3857a5cSMike Waychison }; 362*a3857a5cSMike Waychison 363*a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_io(struct dmi_sysfs_entry *entry, 364*a3857a5cSMike Waychison const struct dmi_system_event_log *sel, 365*a3857a5cSMike Waychison char *buf, loff_t pos, size_t count) 366*a3857a5cSMike Waychison { 367*a3857a5cSMike Waychison ssize_t wrote = 0; 368*a3857a5cSMike Waychison 369*a3857a5cSMike Waychison sel_io_reader io_reader = sel_io_readers[sel->access_method]; 370*a3857a5cSMike Waychison 371*a3857a5cSMike Waychison while (count && pos < sel->area_length) { 372*a3857a5cSMike Waychison count--; 373*a3857a5cSMike Waychison *(buf++) = io_reader(sel, pos++); 374*a3857a5cSMike Waychison wrote++; 375*a3857a5cSMike Waychison } 376*a3857a5cSMike Waychison 377*a3857a5cSMike Waychison return wrote; 378*a3857a5cSMike Waychison } 379*a3857a5cSMike Waychison 380*a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_phys32(struct dmi_sysfs_entry *entry, 381*a3857a5cSMike Waychison const struct dmi_system_event_log *sel, 382*a3857a5cSMike Waychison char *buf, loff_t pos, size_t count) 383*a3857a5cSMike Waychison { 384*a3857a5cSMike Waychison u8 __iomem *mapped; 385*a3857a5cSMike Waychison ssize_t wrote = 0; 386*a3857a5cSMike Waychison 387*a3857a5cSMike Waychison mapped = ioremap(sel->access_method_address, sel->area_length); 388*a3857a5cSMike Waychison if (!mapped) 389*a3857a5cSMike Waychison return -EIO; 390*a3857a5cSMike Waychison 391*a3857a5cSMike Waychison while (count && pos < sel->area_length) { 392*a3857a5cSMike Waychison count--; 393*a3857a5cSMike Waychison *(buf++) = readb(mapped + pos++); 394*a3857a5cSMike Waychison wrote++; 395*a3857a5cSMike Waychison } 396*a3857a5cSMike Waychison 397*a3857a5cSMike Waychison iounmap(mapped); 398*a3857a5cSMike Waychison return wrote; 399*a3857a5cSMike Waychison } 400*a3857a5cSMike Waychison 401*a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read_helper(struct dmi_sysfs_entry *entry, 402*a3857a5cSMike Waychison const struct dmi_header *dh, 403*a3857a5cSMike Waychison void *_state) 404*a3857a5cSMike Waychison { 405*a3857a5cSMike Waychison struct dmi_read_state *state = _state; 406*a3857a5cSMike Waychison const struct dmi_system_event_log *sel = to_sel(dh); 407*a3857a5cSMike Waychison 408*a3857a5cSMike Waychison if (sizeof(*sel) > dmi_entry_length(dh)) 409*a3857a5cSMike Waychison return -EIO; 410*a3857a5cSMike Waychison 411*a3857a5cSMike Waychison switch (sel->access_method) { 412*a3857a5cSMike Waychison case DMI_SEL_ACCESS_METHOD_IO8: 413*a3857a5cSMike Waychison case DMI_SEL_ACCESS_METHOD_IO2x8: 414*a3857a5cSMike Waychison case DMI_SEL_ACCESS_METHOD_IO16: 415*a3857a5cSMike Waychison return dmi_sel_raw_read_io(entry, sel, state->buf, 416*a3857a5cSMike Waychison state->pos, state->count); 417*a3857a5cSMike Waychison case DMI_SEL_ACCESS_METHOD_PHYS32: 418*a3857a5cSMike Waychison return dmi_sel_raw_read_phys32(entry, sel, state->buf, 419*a3857a5cSMike Waychison state->pos, state->count); 420*a3857a5cSMike Waychison case DMI_SEL_ACCESS_METHOD_GPNV: 421*a3857a5cSMike Waychison pr_info("dmi-sysfs: GPNV support missing.\n"); 422*a3857a5cSMike Waychison return -EIO; 423*a3857a5cSMike Waychison default: 424*a3857a5cSMike Waychison pr_info("dmi-sysfs: Unknown access method %02x\n", 425*a3857a5cSMike Waychison sel->access_method); 426*a3857a5cSMike Waychison return -EIO; 427*a3857a5cSMike Waychison } 428*a3857a5cSMike Waychison } 429*a3857a5cSMike Waychison 430*a3857a5cSMike Waychison static ssize_t dmi_sel_raw_read(struct file *filp, struct kobject *kobj, 431*a3857a5cSMike Waychison struct bin_attribute *bin_attr, 432*a3857a5cSMike Waychison char *buf, loff_t pos, size_t count) 433*a3857a5cSMike Waychison { 434*a3857a5cSMike Waychison struct dmi_sysfs_entry *entry = to_entry(kobj->parent); 435*a3857a5cSMike Waychison struct dmi_read_state state = { 436*a3857a5cSMike Waychison .buf = buf, 437*a3857a5cSMike Waychison .pos = pos, 438*a3857a5cSMike Waychison .count = count, 439*a3857a5cSMike Waychison }; 440*a3857a5cSMike Waychison 441*a3857a5cSMike Waychison return find_dmi_entry(entry, dmi_sel_raw_read_helper, &state); 442*a3857a5cSMike Waychison } 443*a3857a5cSMike Waychison 444*a3857a5cSMike Waychison static struct bin_attribute dmi_sel_raw_attr = { 445*a3857a5cSMike Waychison .attr = {.name = "raw_event_log", .mode = 0400}, 446*a3857a5cSMike Waychison .read = dmi_sel_raw_read, 447*a3857a5cSMike Waychison }; 448*a3857a5cSMike 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; 462*a3857a5cSMike Waychison 463*a3857a5cSMike Waychison ret = sysfs_create_bin_file(entry->child, &dmi_sel_raw_attr); 464*a3857a5cSMike Waychison if (ret) 465*a3857a5cSMike Waychison goto out_del; 466*a3857a5cSMike Waychison 467*a3857a5cSMike Waychison return 0; 468*a3857a5cSMike Waychison 469*a3857a5cSMike Waychison out_del: 470*a3857a5cSMike 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