[deliverable/linux.git] / drivers / firmware / efi / esrt.c

/*
 * esrt.c
 *
 * This module exports EFI System Resource Table (ESRT) entries into userspace
 * through the sysfs file system. The ESRT provides a read-only catalog of
 * system components for which the system accepts firmware upgrades via UEFI's
 * "Capsule Update" feature. This module allows userland utilities to evaluate
 * what firmware updates can be applied to this system, and potentially arrange
 * for those updates to occur.
 *
 * Data is currently found below /sys/firmware/efi/esrt/...
 */
#define pr_fmt(fmt) "esrt: " fmt

#include <linux/capability.h>
#include <linux/device.h>
#include <linux/efi.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/kobject.h>
#include <linux/list.h>
#include <linux/memblock.h>
#include <linux/slab.h>
#include <linux/types.h>

#include <asm/io.h>
#include <asm/early_ioremap.h>

struct efi_system_resource_entry_v1 {
	efi_guid_t	fw_class;
	u32		fw_type;
	u32		fw_version;
	u32		lowest_supported_fw_version;
	u32		capsule_flags;
	u32		last_attempt_version;
	u32		last_attempt_status;
};

/*
 * _count and _version are what they seem like.  _max is actually just
 * accounting info for the firmware when creating the table; it should never
 * have been exposed to us.  To wit, the spec says:
 * The maximum number of resource array entries that can be within the
 * table without reallocating the table, must not be zero.
 * Since there's no guidance about what that means in terms of memory layout,
 * it means nothing to us.
 */
struct efi_system_resource_table {
	u32	fw_resource_count;
	u32	fw_resource_count_max;
	u64	fw_resource_version;
	u8	entries[];
};

static phys_addr_t esrt_data;
static size_t esrt_data_size;

static struct efi_system_resource_table *esrt;

struct esre_entry {
	union {
		struct efi_system_resource_entry_v1 *esre1;
	} esre;

	struct kobject kobj;
	struct list_head list;
};

/* global list of esre_entry. */
static LIST_HEAD(entry_list);

/* entry attribute */
struct esre_attribute {
	struct attribute attr;
	ssize_t (*show)(struct esre_entry *entry, char *buf);
	ssize_t (*store)(struct esre_entry *entry,
			 const char *buf, size_t count);
};

static struct esre_entry *to_entry(struct kobject *kobj)
{
	return container_of(kobj, struct esre_entry, kobj);
}

static struct esre_attribute *to_attr(struct attribute *attr)
{
	return container_of(attr, struct esre_attribute, attr);
}

static ssize_t esre_attr_show(struct kobject *kobj,
			      struct attribute *_attr, char *buf)
{
	struct esre_entry *entry = to_entry(kobj);
	struct esre_attribute *attr = to_attr(_attr);

	/* Don't tell normal users what firmware versions we've got... */
	if (!capable(CAP_SYS_ADMIN))
		return -EACCES;

	return attr->show(entry, buf);
}

static const struct sysfs_ops esre_attr_ops = {
	.show = esre_attr_show,
};

/* Generic ESRT Entry ("ESRE") support. */
static ssize_t esre_fw_class_show(struct esre_entry *entry, char *buf)
{
	char *str = buf;

	efi_guid_to_str(&entry->esre.esre1->fw_class, str);
	str += strlen(str);
	str += sprintf(str, "\n");

	return str - buf;
}

static struct esre_attribute esre_fw_class = __ATTR(fw_class, 0400,
	esre_fw_class_show, NULL);

#define esre_attr_decl(name, size, fmt) \
static ssize_t esre_##name##_show(struct esre_entry *entry, char *buf) \
{ \
	return sprintf(buf, fmt "\n", \
		       le##size##_to_cpu(entry->esre.esre1->name)); \
} \
\
static struct esre_attribute esre_##name = __ATTR(name, 0400, \
	esre_##name##_show, NULL)

esre_attr_decl(fw_type, 32, "%u");
esre_attr_decl(fw_version, 32, "%u");
esre_attr_decl(lowest_supported_fw_version, 32, "%u");
esre_attr_decl(capsule_flags, 32, "0x%x");
esre_attr_decl(last_attempt_version, 32, "%u");
esre_attr_decl(last_attempt_status, 32, "%u");

static struct attribute *esre1_attrs[] = {
	&esre_fw_class.attr,
	&esre_fw_type.attr,
	&esre_fw_version.attr,
	&esre_lowest_supported_fw_version.attr,
	&esre_capsule_flags.attr,
	&esre_last_attempt_version.attr,
	&esre_last_attempt_status.attr,
	NULL
};
static void esre_release(struct kobject *kobj)
{
	struct esre_entry *entry = to_entry(kobj);

	list_del(&entry->list);
	kfree(entry);
}

static struct kobj_type esre1_ktype = {
	.release = esre_release,
	.sysfs_ops = &esre_attr_ops,
	.default_attrs = esre1_attrs,
};


static struct kobject *esrt_kobj;
static struct kset *esrt_kset;

static int esre_create_sysfs_entry(void *esre, int entry_num)
{
	struct esre_entry *entry;
	char name[20];

	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
	if (!entry)
		return -ENOMEM;

	sprintf(name, "entry%d", entry_num);

	entry->kobj.kset = esrt_kset;

	if (esrt->fw_resource_version == 1) {
		int rc = 0;

		entry->esre.esre1 = esre;
		rc = kobject_init_and_add(&entry->kobj, &esre1_ktype, NULL,
					  "%s", name);
		if (rc) {
			kfree(entry);
			return rc;
		}
	}

	list_add_tail(&entry->list, &entry_list);
	return 0;
}

/* support for displaying ESRT fields at the top level */
#define esrt_attr_decl(name, size, fmt) \
static ssize_t esrt_##name##_show(struct kobject *kobj, \
				  struct kobj_attribute *attr, char *buf)\
{ \
	return sprintf(buf, fmt "\n", le##size##_to_cpu(esrt->name)); \
} \
\
static struct kobj_attribute esrt_##name = __ATTR(name, 0400, \
	esrt_##name##_show, NULL)

esrt_attr_decl(fw_resource_count, 32, "%u");
esrt_attr_decl(fw_resource_count_max, 32, "%u");
esrt_attr_decl(fw_resource_version, 64, "%llu");

static struct attribute *esrt_attrs[] = {
	&esrt_fw_resource_count.attr,
	&esrt_fw_resource_count_max.attr,
	&esrt_fw_resource_version.attr,
	NULL,
};

static inline int esrt_table_exists(void)
{
	if (!efi_enabled(EFI_CONFIG_TABLES))
		return 0;
	if (efi.esrt == EFI_INVALID_TABLE_ADDR)
		return 0;
	return 1;
}

static umode_t esrt_attr_is_visible(struct kobject *kobj,
				    struct attribute *attr, int n)
{
	if (!esrt_table_exists())
		return 0;
	return attr->mode;
}

static struct attribute_group esrt_attr_group = {
	.attrs = esrt_attrs,
	.is_visible = esrt_attr_is_visible,
};

/*
 * remap the table, copy it to kmalloced pages, and unmap it.
 */
void __init efi_esrt_init(void)
{
	void *va;
	struct efi_system_resource_table tmpesrt;
	struct efi_system_resource_entry_v1 *v1_entries;
	size_t size, max, entry_size, entries_size;
	efi_memory_desc_t md;
	int rc;
	phys_addr_t end;

	pr_debug("esrt-init: loading.\n");
	if (!esrt_table_exists())
		return;

	rc = efi_mem_desc_lookup(efi.esrt, &md);
	if (rc < 0) {
		pr_err("ESRT header is not in the memory map.\n");
		return;
	}

	max = efi_mem_desc_end(&md);
	if (max < efi.esrt) {
		pr_err("EFI memory descriptor is invalid. (esrt: %p max: %p)\n",
		       (void *)efi.esrt, (void *)max);
		return;
	}

	size = sizeof(*esrt);
	max -= efi.esrt;

	if (max < size) {
		pr_err("ESRT header doen't fit on single memory map entry. (size: %zu max: %zu)\n",
		       size, max);
		return;
	}

	va = early_memremap(efi.esrt, size);
	if (!va) {
		pr_err("early_memremap(%p, %zu) failed.\n", (void *)efi.esrt,
		       size);
		return;
	}

	memcpy(&tmpesrt, va, sizeof(tmpesrt));

	if (tmpesrt.fw_resource_version == 1) {
		entry_size = sizeof (*v1_entries);
	} else {
		pr_err("Unsupported ESRT version %lld.\n",
		       tmpesrt.fw_resource_version);
		return;
	}

	if (tmpesrt.fw_resource_count > 0 && max - size < entry_size) {
		pr_err("ESRT memory map entry can only hold the header. (max: %zu size: %zu)\n",
		       max - size, entry_size);
		goto err_memunmap;
	}

	/*
	 * The format doesn't really give us any boundary to test here,
	 * so I'm making up 128 as the max number of individually updatable
	 * components we support.
	 * 128 should be pretty excessive, but there's still some chance
	 * somebody will do that someday and we'll need to raise this.
	 */
	if (tmpesrt.fw_resource_count > 128) {
		pr_err("ESRT says fw_resource_count has very large value %d.\n",
		       tmpesrt.fw_resource_count);
		goto err_memunmap;
	}

	/*
	 * We know it can't be larger than N * sizeof() here, and N is limited
	 * by the previous test to a small number, so there's no overflow.
	 */
	entries_size = tmpesrt.fw_resource_count * entry_size;
	if (max < size + entries_size) {
		pr_err("ESRT does not fit on single memory map entry (size: %zu max: %zu)\n",
		       size, max);
		goto err_memunmap;
	}

	/* remap it with our (plausible) new pages */
	early_memunmap(va, size);
	size += entries_size;
	va = early_memremap(efi.esrt, size);
	if (!va) {
		pr_err("early_memremap(%p, %zu) failed.\n", (void *)efi.esrt,
		       size);
		return;
	}

	esrt_data = (phys_addr_t)efi.esrt;
	esrt_data_size = size;

	end = esrt_data + size;
	pr_info("Reserving ESRT space from %pa to %pa.\n", &esrt_data, &end);
	memblock_reserve(esrt_data, esrt_data_size);

	pr_debug("esrt-init: loaded.\n");
err_memunmap:
	early_memunmap(va, size);
}

static int __init register_entries(void)
{
	struct efi_system_resource_entry_v1 *v1_entries = (void *)esrt->entries;
	int i, rc;

	if (!esrt_table_exists())
		return 0;

	for (i = 0; i < le32_to_cpu(esrt->fw_resource_count); i++) {
		void *esre = NULL;
		if (esrt->fw_resource_version == 1) {
			esre = &v1_entries[i];
		} else {
			pr_err("Unsupported ESRT version %lld.\n",
			       esrt->fw_resource_version);
			return -EINVAL;
		}

		rc = esre_create_sysfs_entry(esre, i);
		if (rc < 0) {
			pr_err("ESRT entry creation failed with error %d.\n",
			       rc);
			return rc;
		}
	}
	return 0;
}

static void cleanup_entry_list(void)
{
	struct esre_entry *entry, *next;

	list_for_each_entry_safe(entry, next, &entry_list, list) {
		kobject_put(&entry->kobj);
	}
}

static int __init esrt_sysfs_init(void)
{
	int error;
	struct efi_system_resource_table __iomem *ioesrt;

	pr_debug("esrt-sysfs: loading.\n");
	if (!esrt_data || !esrt_data_size)
		return -ENOSYS;

	ioesrt = ioremap(esrt_data, esrt_data_size);
	if (!ioesrt) {
		pr_err("ioremap(%pa, %zu) failed.\n", &esrt_data,
		       esrt_data_size);
		return -ENOMEM;
	}

	esrt = kmalloc(esrt_data_size, GFP_KERNEL);
	if (!esrt) {
		pr_err("kmalloc failed. (wanted %zu bytes)\n", esrt_data_size);
		iounmap(ioesrt);
		return -ENOMEM;
	}

	memcpy_fromio(esrt, ioesrt, esrt_data_size);

	esrt_kobj = kobject_create_and_add("esrt", efi_kobj);
	if (!esrt_kobj) {
		pr_err("Firmware table registration failed.\n");
		error = -ENOMEM;
		goto err;
	}

	error = sysfs_create_group(esrt_kobj, &esrt_attr_group);
	if (error) {
		pr_err("Sysfs attribute export failed with error %d.\n",
		       error);
		goto err_remove_esrt;
	}

	esrt_kset = kset_create_and_add("entries", NULL, esrt_kobj);
	if (!esrt_kset) {
		pr_err("kset creation failed.\n");
		error = -ENOMEM;
		goto err_remove_group;
	}

	error = register_entries();
	if (error)
		goto err_cleanup_list;

	memblock_remove(esrt_data, esrt_data_size);

	pr_debug("esrt-sysfs: loaded.\n");

	return 0;
err_cleanup_list:
	cleanup_entry_list();
	kset_unregister(esrt_kset);
err_remove_group:
	sysfs_remove_group(esrt_kobj, &esrt_attr_group);
err_remove_esrt:
	kobject_put(esrt_kobj);
err:
	kfree(esrt);
	esrt = NULL;
	return error;
}
device_initcall(esrt_sysfs_init);

/*
MODULE_AUTHOR("Peter Jones <pjones@redhat.com>");
MODULE_DESCRIPTION("EFI System Resource Table support");
MODULE_LICENSE("GPL");
*/
Commit	Line	Data
0bb54905 PJ	1	/*
	2	* esrt.c
	3	*
	4	* This module exports EFI System Resource Table (ESRT) entries into userspace
	5	* through the sysfs file system. The ESRT provides a read-only catalog of
	6	* system components for which the system accepts firmware upgrades via UEFI's
	7	* "Capsule Update" feature. This module allows userland utilities to evaluate
	8	* what firmware updates can be applied to this system, and potentially arrange
	9	* for those updates to occur.
	10	*
	11	* Data is currently found below /sys/firmware/efi/esrt/...
	12	*/
	13	#define pr_fmt(fmt) "esrt: " fmt
	14
	15	#include <linux/capability.h>
	16	#include <linux/device.h>
	17	#include <linux/efi.h>
	18	#include <linux/init.h>
	19	#include <linux/kernel.h>
	20	#include <linux/kobject.h>
	21	#include <linux/list.h>
	22	#include <linux/memblock.h>
0bb54905 PJ	23	#include <linux/slab.h>
	24	#include <linux/types.h>
	25
	26	#include <asm/io.h>
	27	#include <asm/early_ioremap.h>
	28
	29	struct efi_system_resource_entry_v1 {
	30	efi_guid_t fw_class;
	31	u32 fw_type;
	32	u32 fw_version;
	33	u32 lowest_supported_fw_version;
	34	u32 capsule_flags;
	35	u32 last_attempt_version;
	36	u32 last_attempt_status;
	37	};
	38
	39	/*
	40	* _count and _version are what they seem like. _max is actually just
	41	* accounting info for the firmware when creating the table; it should never
	42	* have been exposed to us. To wit, the spec says:
	43	* The maximum number of resource array entries that can be within the
	44	* table without reallocating the table, must not be zero.
	45	* Since there's no guidance about what that means in terms of memory layout,
	46	* it means nothing to us.
	47	*/
	48	struct efi_system_resource_table {
	49	u32 fw_resource_count;
	50	u32 fw_resource_count_max;
	51	u64 fw_resource_version;
	52	u8 entries[];
	53	};
	54
	55	static phys_addr_t esrt_data;
	56	static size_t esrt_data_size;
	57
	58	static struct efi_system_resource_table *esrt;
	59
	60	struct esre_entry {
	61	union {
	62	struct efi_system_resource_entry_v1 *esre1;
	63	} esre;
	64
	65	struct kobject kobj;
	66	struct list_head list;
	67	};
	68
	69	/* global list of esre_entry. */
	70	static LIST_HEAD(entry_list);
	71
	72	/* entry attribute */
	73	struct esre_attribute {
	74	struct attribute attr;
	75	ssize_t (show)(struct esre_entry entry, char *buf);
	76	ssize_t (store)(struct esre_entry entry,
	77	const char *buf, size_t count);
	78	};
	79
	80	static struct esre_entry to_entry(struct kobject kobj)
	81	{
	82	return container_of(kobj, struct esre_entry, kobj);
	83	}
	84
	85	static struct esre_attribute to_attr(struct attribute attr)
	86	{
87	return container_of(attr, struct esre_attribute, attr);
88	}
89
90	static ssize_t esre_attr_show(struct kobject *kobj,
91	struct attribute _attr, char buf)
92	{
93	struct esre_entry *entry = to_entry(kobj);
94	struct esre_attribute *attr = to_attr(_attr);
95
96	/* Don't tell normal users what firmware versions we've got... */
97	if (!capable(CAP_SYS_ADMIN))
98	return -EACCES;
99
100	return attr->show(entry, buf);
101	}
102
103	static const struct sysfs_ops esre_attr_ops = {
104	.show = esre_attr_show,
105	};
106
107	/* Generic ESRT Entry ("ESRE") support. */
108	static ssize_t esre_fw_class_show(struct esre_entry entry, char buf)
109	{
110	char *str = buf;
111
112	efi_guid_to_str(&entry->esre.esre1->fw_class, str);
113	str += strlen(str);
114	str += sprintf(str, "\n");
115
116	return str - buf;
117	}
118
119	static struct esre_attribute esre_fw_class = __ATTR(fw_class, 0400,
120	esre_fw_class_show, NULL);
121
122	#define esre_attr_decl(name, size, fmt) \
123	static ssize_t esre_##name##_show(struct esre_entry entry, char buf) \
124	{ \
125	return sprintf(buf, fmt "\n", \
126	le##size##_to_cpu(entry->esre.esre1->name)); \
127	} \
128	\
129	static struct esre_attribute esre_##name = __ATTR(name, 0400, \
130	esre_##name##_show, NULL)
131
132	esre_attr_decl(fw_type, 32, "%u");
133	esre_attr_decl(fw_version, 32, "%u");
134	esre_attr_decl(lowest_supported_fw_version, 32, "%u");
135	esre_attr_decl(capsule_flags, 32, "0x%x");
136	esre_attr_decl(last_attempt_version, 32, "%u");
137	esre_attr_decl(last_attempt_status, 32, "%u");
138
139	static struct attribute *esre1_attrs[] = {
140	&esre_fw_class.attr,
141	&esre_fw_type.attr,
142	&esre_fw_version.attr,
143	&esre_lowest_supported_fw_version.attr,
144	&esre_capsule_flags.attr,
145	&esre_last_attempt_version.attr,
146	&esre_last_attempt_status.attr,
147	NULL
148	};
149	static void esre_release(struct kobject *kobj)
150	{
151	struct esre_entry *entry = to_entry(kobj);
152
153	list_del(&entry->list);
154	kfree(entry);
155	}
156
157	static struct kobj_type esre1_ktype = {
158	.release = esre_release,
159	.sysfs_ops = &esre_attr_ops,
160	.default_attrs = esre1_attrs,
161	};
162
163
164	static struct kobject *esrt_kobj;
165	static struct kset *esrt_kset;
166
167	static int esre_create_sysfs_entry(void *esre, int entry_num)
168	{
0bb54905 PJ	169	struct esre_entry *entry;
	170	char name[20];
	171
	172	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
	173	if (!entry)
	174	return -ENOMEM;
	175
	176	sprintf(name, "entry%d", entry_num);
	177
	178	entry->kobj.kset = esrt_kset;
	179
	180	if (esrt->fw_resource_version == 1) {
f2f6b587 PJ	181	int rc = 0;
f2f6b587 PJ	182
0bb54905 PJ	183	entry->esre.esre1 = esre;
	184	rc = kobject_init_and_add(&entry->kobj, &esre1_ktype, NULL,
	185	"%s", name);
f2f6b587 PJ	186	if (rc) {
	187	kfree(entry);
	188	return rc;
	189	}
0bb54905 PJ	190	}
	191
	192	list_add_tail(&entry->list, &entry_list);
	193	return 0;
	194	}
	195
	196	/* support for displaying ESRT fields at the top level */
	197	#define esrt_attr_decl(name, size, fmt) \
	198	static ssize_t esrt_##name##_show(struct kobject *kobj, \
	199	struct kobj_attribute attr, char buf)\
	200	{ \
	201	return sprintf(buf, fmt "\n", le##size##_to_cpu(esrt->name)); \
	202	} \
	203	\
	204	static struct kobj_attribute esrt_##name = __ATTR(name, 0400, \
	205	esrt_##name##_show, NULL)
	206
	207	esrt_attr_decl(fw_resource_count, 32, "%u");
	208	esrt_attr_decl(fw_resource_count_max, 32, "%u");
	209	esrt_attr_decl(fw_resource_version, 64, "%llu");
	210
	211	static struct attribute *esrt_attrs[] = {
	212	&esrt_fw_resource_count.attr,
	213	&esrt_fw_resource_count_max.attr,
	214	&esrt_fw_resource_version.attr,
	215	NULL,
	216	};
	217
	218	static inline int esrt_table_exists(void)
	219	{
	220	if (!efi_enabled(EFI_CONFIG_TABLES))
	221	return 0;
	222	if (efi.esrt == EFI_INVALID_TABLE_ADDR)
	223	return 0;
	224	return 1;
	225	}
	226
	227	static umode_t esrt_attr_is_visible(struct kobject *kobj,
	228	struct attribute *attr, int n)
	229	{
	230	if (!esrt_table_exists())
	231	return 0;
	232	return attr->mode;
	233	}
	234
	235	static struct attribute_group esrt_attr_group = {
	236	.attrs = esrt_attrs,
	237	.is_visible = esrt_attr_is_visible,
	238	};
	239
	240	/*
	241	* remap the table, copy it to kmalloced pages, and unmap it.
	242	*/
	243	void __init efi_esrt_init(void)
	244	{
	245	void *va;
	246	struct efi_system_resource_table tmpesrt;
	247	struct efi_system_resource_entry_v1 *v1_entries;
	248	size_t size, max, entry_size, entries_size;
	249	efi_memory_desc_t md;
	250	int rc;
f2f6b587	251	phys_addr_t end;
0bb54905 PJ	252
	253	pr_debug("esrt-init: loading.\n");
	254	if (!esrt_table_exists())
	255	return;
	256
	257	rc = efi_mem_desc_lookup(efi.esrt, &md);
	258	if (rc < 0) {
	259	pr_err("ESRT header is not in the memory map.\n");
	260	return;
	261	}
	262
	263	max = efi_mem_desc_end(&md);
	264	if (max < efi.esrt) {
	265	pr_err("EFI memory descriptor is invalid. (esrt: %p max: %p)\n",
	266	(void )efi.esrt, (void )max);
	267	return;
	268	}
	269
	270	size = sizeof(*esrt);
	271	max -= efi.esrt;
	272
	273	if (max < size) {
	274	pr_err("ESRT header doen't fit on single memory map entry. (size: %zu max: %zu)\n",
	275	size, max);
	276	return;
	277	}
	278
	279	va = early_memremap(efi.esrt, size);
	280	if (!va) {
	281	pr_err("early_memremap(%p, %zu) failed.\n", (void *)efi.esrt,
	282	size);
	283	return;
	284	}
	285
	286	memcpy(&tmpesrt, va, sizeof(tmpesrt));
	287
	288	if (tmpesrt.fw_resource_version == 1) {
	289	entry_size = sizeof (*v1_entries);
	290	} else {
	291	pr_err("Unsupported ESRT version %lld.\n",
	292	tmpesrt.fw_resource_version);
	293	return;
	294	}
	295
	296	if (tmpesrt.fw_resource_count > 0 && max - size < entry_size) {
	297	pr_err("ESRT memory map entry can only hold the header. (max: %zu size: %zu)\n",
	298	max - size, entry_size);
	299	goto err_memunmap;
	300	}
	301
	302	/*
	303	* The format doesn't really give us any boundary to test here,
	304	* so I'm making up 128 as the max number of individually updatable
	305	* components we support.
	306	* 128 should be pretty excessive, but there's still some chance
	307	* somebody will do that someday and we'll need to raise this.
	308	*/
	309	if (tmpesrt.fw_resource_count > 128) {
	310	pr_err("ESRT says fw_resource_count has very large value %d.\n",
	311	tmpesrt.fw_resource_count);
	312	goto err_memunmap;
	313	}
	314
	315	/*
316	* We know it can't be larger than N * sizeof() here, and N is limited
317	* by the previous test to a small number, so there's no overflow.
318	*/
319	entries_size = tmpesrt.fw_resource_count * entry_size;
320	if (max < size + entries_size) {
321	pr_err("ESRT does not fit on single memory map entry (size: %zu max: %zu)\n",
322	size, max);
323	goto err_memunmap;
324	}
325
326	/* remap it with our (plausible) new pages */
327	early_memunmap(va, size);
328	size += entries_size;
329	va = early_memremap(efi.esrt, size);
330	if (!va) {
331	pr_err("early_memremap(%p, %zu) failed.\n", (void *)efi.esrt,
332	size);
333	return;
334	}
335
336	esrt_data = (phys_addr_t)efi.esrt;
337	esrt_data_size = size;
338
f2f6b587 PJ	339	end = esrt_data + size;
f2f6b587 PJ	340	pr_info("Reserving ESRT space from %pa to %pa.\n", &esrt_data, &end);
0bb54905 PJ	341	memblock_reserve(esrt_data, esrt_data_size);
	342
	343	pr_debug("esrt-init: loaded.\n");
	344	err_memunmap:
	345	early_memunmap(va, size);
	346	}
	347
	348	static int __init register_entries(void)
	349	{
	350	struct efi_system_resource_entry_v1 v1_entries = (void )esrt->entries;
	351	int i, rc;
	352
	353	if (!esrt_table_exists())
	354	return 0;
	355
	356	for (i = 0; i < le32_to_cpu(esrt->fw_resource_count); i++) {
f2f6b587	357	void *esre = NULL;
0bb54905	358	if (esrt->fw_resource_version == 1) {
f2f6b587 PJ	359	esre = &v1_entries[i];
	360	} else {
	361	pr_err("Unsupported ESRT version %lld.\n",
	362	esrt->fw_resource_version);
	363	return -EINVAL;
0bb54905	364	}
f2f6b587 PJ	365
f2f6b587 PJ	366	rc = esre_create_sysfs_entry(esre, i);
0bb54905 PJ	367	if (rc < 0) {
	368	pr_err("ESRT entry creation failed with error %d.\n",
	369	rc);
	370	return rc;
	371	}
	372	}
	373	return 0;
	374	}
	375
	376	static void cleanup_entry_list(void)
	377	{
	378	struct esre_entry entry, next;
	379
	380	list_for_each_entry_safe(entry, next, &entry_list, list) {
	381	kobject_put(&entry->kobj);
	382	}
	383	}
	384
	385	static int __init esrt_sysfs_init(void)
	386	{
	387	int error;
	388	struct efi_system_resource_table __iomem *ioesrt;
	389
	390	pr_debug("esrt-sysfs: loading.\n");
	391	if (!esrt_data \|\| !esrt_data_size)
	392	return -ENOSYS;
	393
	394	ioesrt = ioremap(esrt_data, esrt_data_size);
	395	if (!ioesrt) {
f2f6b587	396	pr_err("ioremap(%pa, %zu) failed.\n", &esrt_data,
0bb54905 PJ	397	esrt_data_size);
	398	return -ENOMEM;
	399	}
	400
	401	esrt = kmalloc(esrt_data_size, GFP_KERNEL);
	402	if (!esrt) {
	403	pr_err("kmalloc failed. (wanted %zu bytes)\n", esrt_data_size);
	404	iounmap(ioesrt);
	405	return -ENOMEM;
	406	}
	407
	408	memcpy_fromio(esrt, ioesrt, esrt_data_size);
	409
	410	esrt_kobj = kobject_create_and_add("esrt", efi_kobj);
	411	if (!esrt_kobj) {
	412	pr_err("Firmware table registration failed.\n");
	413	error = -ENOMEM;
	414	goto err;
	415	}
	416
	417	error = sysfs_create_group(esrt_kobj, &esrt_attr_group);
	418	if (error) {
	419	pr_err("Sysfs attribute export failed with error %d.\n",
	420	error);
	421	goto err_remove_esrt;
	422	}
	423
	424	esrt_kset = kset_create_and_add("entries", NULL, esrt_kobj);
	425	if (!esrt_kset) {
	426	pr_err("kset creation failed.\n");
	427	error = -ENOMEM;
	428	goto err_remove_group;
	429	}
	430
	431	error = register_entries();
	432	if (error)
	433	goto err_cleanup_list;
	434
	435	memblock_remove(esrt_data, esrt_data_size);
	436
	437	pr_debug("esrt-sysfs: loaded.\n");
	438
	439	return 0;
	440	err_cleanup_list:
	441	cleanup_entry_list();
	442	kset_unregister(esrt_kset);
	443	err_remove_group:
	444	sysfs_remove_group(esrt_kobj, &esrt_attr_group);
	445	err_remove_esrt:
	446	kobject_put(esrt_kobj);
	447	err:
	448	kfree(esrt);
	449	esrt = NULL;
	450	return error;
	451	}
18aefbc5	452	device_initcall(esrt_sysfs_init);
0bb54905	453
18aefbc5	454	/*
0bb54905 PJ	455	MODULE_AUTHOR("Peter Jones <pjones@redhat.com>");
	456	MODULE_DESCRIPTION("EFI System Resource Table support");
	457	MODULE_LICENSE("GPL");
18aefbc5	458	*/