Loading...
1/*
2 * linux/drivers/firmware/memmap.c
3 * Copyright (C) 2008 SUSE LINUX Products GmbH
4 * by Bernhard Walle <bernhard.walle@gmx.de>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License v2.0 as published by
8 * the Free Software Foundation
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 */
16
17#include <linux/string.h>
18#include <linux/firmware-map.h>
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/types.h>
22#include <linux/bootmem.h>
23#include <linux/slab.h>
24
25/*
26 * Data types ------------------------------------------------------------------
27 */
28
29/*
30 * Firmware map entry. Because firmware memory maps are flat and not
31 * hierarchical, it's ok to organise them in a linked list. No parent
32 * information is necessary as for the resource tree.
33 */
34struct firmware_map_entry {
35 /*
36 * start and end must be u64 rather than resource_size_t, because e820
37 * resources can lie at addresses above 4G.
38 */
39 u64 start; /* start of the memory range */
40 u64 end; /* end of the memory range (incl.) */
41 const char *type; /* type of the memory range */
42 struct list_head list; /* entry for the linked list */
43 struct kobject kobj; /* kobject for each entry */
44};
45
46/*
47 * Forward declarations --------------------------------------------------------
48 */
49static ssize_t memmap_attr_show(struct kobject *kobj,
50 struct attribute *attr, char *buf);
51static ssize_t start_show(struct firmware_map_entry *entry, char *buf);
52static ssize_t end_show(struct firmware_map_entry *entry, char *buf);
53static ssize_t type_show(struct firmware_map_entry *entry, char *buf);
54
55/*
56 * Static data -----------------------------------------------------------------
57 */
58
59struct memmap_attribute {
60 struct attribute attr;
61 ssize_t (*show)(struct firmware_map_entry *entry, char *buf);
62};
63
64static struct memmap_attribute memmap_start_attr = __ATTR_RO(start);
65static struct memmap_attribute memmap_end_attr = __ATTR_RO(end);
66static struct memmap_attribute memmap_type_attr = __ATTR_RO(type);
67
68/*
69 * These are default attributes that are added for every memmap entry.
70 */
71static struct attribute *def_attrs[] = {
72 &memmap_start_attr.attr,
73 &memmap_end_attr.attr,
74 &memmap_type_attr.attr,
75 NULL
76};
77
78static const struct sysfs_ops memmap_attr_ops = {
79 .show = memmap_attr_show,
80};
81
82static struct kobj_type memmap_ktype = {
83 .sysfs_ops = &memmap_attr_ops,
84 .default_attrs = def_attrs,
85};
86
87/*
88 * Registration functions ------------------------------------------------------
89 */
90
91/*
92 * Firmware memory map entries. No locking is needed because the
93 * firmware_map_add() and firmware_map_add_early() functions are called
94 * in firmware initialisation code in one single thread of execution.
95 */
96static LIST_HEAD(map_entries);
97
98/**
99 * firmware_map_add_entry() - Does the real work to add a firmware memmap entry.
100 * @start: Start of the memory range.
101 * @end: End of the memory range (inclusive).
102 * @type: Type of the memory range.
103 * @entry: Pre-allocated (either kmalloc() or bootmem allocator), uninitialised
104 * entry.
105 *
106 * Common implementation of firmware_map_add() and firmware_map_add_early()
107 * which expects a pre-allocated struct firmware_map_entry.
108 **/
109static int firmware_map_add_entry(u64 start, u64 end,
110 const char *type,
111 struct firmware_map_entry *entry)
112{
113 BUG_ON(start > end);
114
115 entry->start = start;
116 entry->end = end;
117 entry->type = type;
118 INIT_LIST_HEAD(&entry->list);
119 kobject_init(&entry->kobj, &memmap_ktype);
120
121 list_add_tail(&entry->list, &map_entries);
122
123 return 0;
124}
125
126/*
127 * Add memmap entry on sysfs
128 */
129static int add_sysfs_fw_map_entry(struct firmware_map_entry *entry)
130{
131 static int map_entries_nr;
132 static struct kset *mmap_kset;
133
134 if (!mmap_kset) {
135 mmap_kset = kset_create_and_add("memmap", NULL, firmware_kobj);
136 if (!mmap_kset)
137 return -ENOMEM;
138 }
139
140 entry->kobj.kset = mmap_kset;
141 if (kobject_add(&entry->kobj, NULL, "%d", map_entries_nr++))
142 kobject_put(&entry->kobj);
143
144 return 0;
145}
146
147/**
148 * firmware_map_add_hotplug() - Adds a firmware mapping entry when we do
149 * memory hotplug.
150 * @start: Start of the memory range.
151 * @end: End of the memory range (inclusive).
152 * @type: Type of the memory range.
153 *
154 * Adds a firmware mapping entry. This function is for memory hotplug, it is
155 * similar to function firmware_map_add_early(). The only difference is that
156 * it will create the syfs entry dynamically.
157 *
158 * Returns 0 on success, or -ENOMEM if no memory could be allocated.
159 **/
160int __meminit firmware_map_add_hotplug(u64 start, u64 end, const char *type)
161{
162 struct firmware_map_entry *entry;
163
164 entry = kzalloc(sizeof(struct firmware_map_entry), GFP_ATOMIC);
165 if (!entry)
166 return -ENOMEM;
167
168 firmware_map_add_entry(start, end, type, entry);
169 /* create the memmap entry */
170 add_sysfs_fw_map_entry(entry);
171
172 return 0;
173}
174
175/**
176 * firmware_map_add_early() - Adds a firmware mapping entry.
177 * @start: Start of the memory range.
178 * @end: End of the memory range (inclusive).
179 * @type: Type of the memory range.
180 *
181 * Adds a firmware mapping entry. This function uses the bootmem allocator
182 * for memory allocation.
183 *
184 * That function must be called before late_initcall.
185 *
186 * Returns 0 on success, or -ENOMEM if no memory could be allocated.
187 **/
188int __init firmware_map_add_early(u64 start, u64 end, const char *type)
189{
190 struct firmware_map_entry *entry;
191
192 entry = alloc_bootmem(sizeof(struct firmware_map_entry));
193 if (WARN_ON(!entry))
194 return -ENOMEM;
195
196 return firmware_map_add_entry(start, end, type, entry);
197}
198
199/*
200 * Sysfs functions -------------------------------------------------------------
201 */
202
203static ssize_t start_show(struct firmware_map_entry *entry, char *buf)
204{
205 return snprintf(buf, PAGE_SIZE, "0x%llx\n",
206 (unsigned long long)entry->start);
207}
208
209static ssize_t end_show(struct firmware_map_entry *entry, char *buf)
210{
211 return snprintf(buf, PAGE_SIZE, "0x%llx\n",
212 (unsigned long long)entry->end);
213}
214
215static ssize_t type_show(struct firmware_map_entry *entry, char *buf)
216{
217 return snprintf(buf, PAGE_SIZE, "%s\n", entry->type);
218}
219
220#define to_memmap_attr(_attr) container_of(_attr, struct memmap_attribute, attr)
221#define to_memmap_entry(obj) container_of(obj, struct firmware_map_entry, kobj)
222
223static ssize_t memmap_attr_show(struct kobject *kobj,
224 struct attribute *attr, char *buf)
225{
226 struct firmware_map_entry *entry = to_memmap_entry(kobj);
227 struct memmap_attribute *memmap_attr = to_memmap_attr(attr);
228
229 return memmap_attr->show(entry, buf);
230}
231
232/*
233 * Initialises stuff and adds the entries in the map_entries list to
234 * sysfs. Important is that firmware_map_add() and firmware_map_add_early()
235 * must be called before late_initcall. That's just because that function
236 * is called as late_initcall() function, which means that if you call
237 * firmware_map_add() or firmware_map_add_early() afterwards, the entries
238 * are not added to sysfs.
239 */
240static int __init memmap_init(void)
241{
242 struct firmware_map_entry *entry;
243
244 list_for_each_entry(entry, &map_entries, list)
245 add_sysfs_fw_map_entry(entry);
246
247 return 0;
248}
249late_initcall(memmap_init);
250
1/*
2 * linux/drivers/firmware/memmap.c
3 * Copyright (C) 2008 SUSE LINUX Products GmbH
4 * by Bernhard Walle <bernhard.walle@gmx.de>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License v2.0 as published by
8 * the Free Software Foundation
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 */
16
17#include <linux/string.h>
18#include <linux/firmware-map.h>
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/types.h>
22#include <linux/bootmem.h>
23#include <linux/slab.h>
24#include <linux/mm.h>
25
26/*
27 * Data types ------------------------------------------------------------------
28 */
29
30/*
31 * Firmware map entry. Because firmware memory maps are flat and not
32 * hierarchical, it's ok to organise them in a linked list. No parent
33 * information is necessary as for the resource tree.
34 */
35struct firmware_map_entry {
36 /*
37 * start and end must be u64 rather than resource_size_t, because e820
38 * resources can lie at addresses above 4G.
39 */
40 u64 start; /* start of the memory range */
41 u64 end; /* end of the memory range (incl.) */
42 const char *type; /* type of the memory range */
43 struct list_head list; /* entry for the linked list */
44 struct kobject kobj; /* kobject for each entry */
45};
46
47/*
48 * Forward declarations --------------------------------------------------------
49 */
50static ssize_t memmap_attr_show(struct kobject *kobj,
51 struct attribute *attr, char *buf);
52static ssize_t start_show(struct firmware_map_entry *entry, char *buf);
53static ssize_t end_show(struct firmware_map_entry *entry, char *buf);
54static ssize_t type_show(struct firmware_map_entry *entry, char *buf);
55
56static struct firmware_map_entry * __meminit
57firmware_map_find_entry(u64 start, u64 end, const char *type);
58
59/*
60 * Static data -----------------------------------------------------------------
61 */
62
63struct memmap_attribute {
64 struct attribute attr;
65 ssize_t (*show)(struct firmware_map_entry *entry, char *buf);
66};
67
68static struct memmap_attribute memmap_start_attr = __ATTR_RO(start);
69static struct memmap_attribute memmap_end_attr = __ATTR_RO(end);
70static struct memmap_attribute memmap_type_attr = __ATTR_RO(type);
71
72/*
73 * These are default attributes that are added for every memmap entry.
74 */
75static struct attribute *def_attrs[] = {
76 &memmap_start_attr.attr,
77 &memmap_end_attr.attr,
78 &memmap_type_attr.attr,
79 NULL
80};
81
82static const struct sysfs_ops memmap_attr_ops = {
83 .show = memmap_attr_show,
84};
85
86/* Firmware memory map entries. */
87static LIST_HEAD(map_entries);
88static DEFINE_SPINLOCK(map_entries_lock);
89
90/*
91 * For memory hotplug, there is no way to free memory map entries allocated
92 * by boot mem after the system is up. So when we hot-remove memory whose
93 * map entry is allocated by bootmem, we need to remember the storage and
94 * reuse it when the memory is hot-added again.
95 */
96static LIST_HEAD(map_entries_bootmem);
97static DEFINE_SPINLOCK(map_entries_bootmem_lock);
98
99
100static inline struct firmware_map_entry *
101to_memmap_entry(struct kobject *kobj)
102{
103 return container_of(kobj, struct firmware_map_entry, kobj);
104}
105
106static void __meminit release_firmware_map_entry(struct kobject *kobj)
107{
108 struct firmware_map_entry *entry = to_memmap_entry(kobj);
109
110 if (PageReserved(virt_to_page(entry))) {
111 /*
112 * Remember the storage allocated by bootmem, and reuse it when
113 * the memory is hot-added again. The entry will be added to
114 * map_entries_bootmem here, and deleted from &map_entries in
115 * firmware_map_remove_entry().
116 */
117 spin_lock(&map_entries_bootmem_lock);
118 list_add(&entry->list, &map_entries_bootmem);
119 spin_unlock(&map_entries_bootmem_lock);
120
121 return;
122 }
123
124 kfree(entry);
125}
126
127static struct kobj_type __refdata memmap_ktype = {
128 .release = release_firmware_map_entry,
129 .sysfs_ops = &memmap_attr_ops,
130 .default_attrs = def_attrs,
131};
132
133/*
134 * Registration functions ------------------------------------------------------
135 */
136
137/**
138 * firmware_map_add_entry() - Does the real work to add a firmware memmap entry.
139 * @start: Start of the memory range.
140 * @end: End of the memory range (exclusive).
141 * @type: Type of the memory range.
142 * @entry: Pre-allocated (either kmalloc() or bootmem allocator), uninitialised
143 * entry.
144 *
145 * Common implementation of firmware_map_add() and firmware_map_add_early()
146 * which expects a pre-allocated struct firmware_map_entry.
147 *
148 * Return: 0 always
149 */
150static int firmware_map_add_entry(u64 start, u64 end,
151 const char *type,
152 struct firmware_map_entry *entry)
153{
154 BUG_ON(start > end);
155
156 entry->start = start;
157 entry->end = end - 1;
158 entry->type = type;
159 INIT_LIST_HEAD(&entry->list);
160 kobject_init(&entry->kobj, &memmap_ktype);
161
162 spin_lock(&map_entries_lock);
163 list_add_tail(&entry->list, &map_entries);
164 spin_unlock(&map_entries_lock);
165
166 return 0;
167}
168
169/**
170 * firmware_map_remove_entry() - Does the real work to remove a firmware
171 * memmap entry.
172 * @entry: removed entry.
173 *
174 * The caller must hold map_entries_lock, and release it properly.
175 */
176static inline void firmware_map_remove_entry(struct firmware_map_entry *entry)
177{
178 list_del(&entry->list);
179}
180
181/*
182 * Add memmap entry on sysfs
183 */
184static int add_sysfs_fw_map_entry(struct firmware_map_entry *entry)
185{
186 static int map_entries_nr;
187 static struct kset *mmap_kset;
188
189 if (entry->kobj.state_in_sysfs)
190 return -EEXIST;
191
192 if (!mmap_kset) {
193 mmap_kset = kset_create_and_add("memmap", NULL, firmware_kobj);
194 if (!mmap_kset)
195 return -ENOMEM;
196 }
197
198 entry->kobj.kset = mmap_kset;
199 if (kobject_add(&entry->kobj, NULL, "%d", map_entries_nr++))
200 kobject_put(&entry->kobj);
201
202 return 0;
203}
204
205/*
206 * Remove memmap entry on sysfs
207 */
208static inline void remove_sysfs_fw_map_entry(struct firmware_map_entry *entry)
209{
210 kobject_put(&entry->kobj);
211}
212
213/**
214 * firmware_map_find_entry_in_list() - Search memmap entry in a given list.
215 * @start: Start of the memory range.
216 * @end: End of the memory range (exclusive).
217 * @type: Type of the memory range.
218 * @list: In which to find the entry.
219 *
220 * This function is to find the memmap entey of a given memory range in a
221 * given list. The caller must hold map_entries_lock, and must not release
222 * the lock until the processing of the returned entry has completed.
223 *
224 * Return: Pointer to the entry to be found on success, or NULL on failure.
225 */
226static struct firmware_map_entry * __meminit
227firmware_map_find_entry_in_list(u64 start, u64 end, const char *type,
228 struct list_head *list)
229{
230 struct firmware_map_entry *entry;
231
232 list_for_each_entry(entry, list, list)
233 if ((entry->start == start) && (entry->end == end) &&
234 (!strcmp(entry->type, type))) {
235 return entry;
236 }
237
238 return NULL;
239}
240
241/**
242 * firmware_map_find_entry() - Search memmap entry in map_entries.
243 * @start: Start of the memory range.
244 * @end: End of the memory range (exclusive).
245 * @type: Type of the memory range.
246 *
247 * This function is to find the memmap entey of a given memory range.
248 * The caller must hold map_entries_lock, and must not release the lock
249 * until the processing of the returned entry has completed.
250 *
251 * Return: Pointer to the entry to be found on success, or NULL on failure.
252 */
253static struct firmware_map_entry * __meminit
254firmware_map_find_entry(u64 start, u64 end, const char *type)
255{
256 return firmware_map_find_entry_in_list(start, end, type, &map_entries);
257}
258
259/**
260 * firmware_map_find_entry_bootmem() - Search memmap entry in map_entries_bootmem.
261 * @start: Start of the memory range.
262 * @end: End of the memory range (exclusive).
263 * @type: Type of the memory range.
264 *
265 * This function is similar to firmware_map_find_entry except that it find the
266 * given entry in map_entries_bootmem.
267 *
268 * Return: Pointer to the entry to be found on success, or NULL on failure.
269 */
270static struct firmware_map_entry * __meminit
271firmware_map_find_entry_bootmem(u64 start, u64 end, const char *type)
272{
273 return firmware_map_find_entry_in_list(start, end, type,
274 &map_entries_bootmem);
275}
276
277/**
278 * firmware_map_add_hotplug() - Adds a firmware mapping entry when we do
279 * memory hotplug.
280 * @start: Start of the memory range.
281 * @end: End of the memory range (exclusive)
282 * @type: Type of the memory range.
283 *
284 * Adds a firmware mapping entry. This function is for memory hotplug, it is
285 * similar to function firmware_map_add_early(). The only difference is that
286 * it will create the syfs entry dynamically.
287 *
288 * Return: 0 on success, or -ENOMEM if no memory could be allocated.
289 */
290int __meminit firmware_map_add_hotplug(u64 start, u64 end, const char *type)
291{
292 struct firmware_map_entry *entry;
293
294 entry = firmware_map_find_entry(start, end - 1, type);
295 if (entry)
296 return 0;
297
298 entry = firmware_map_find_entry_bootmem(start, end - 1, type);
299 if (!entry) {
300 entry = kzalloc(sizeof(struct firmware_map_entry), GFP_ATOMIC);
301 if (!entry)
302 return -ENOMEM;
303 } else {
304 /* Reuse storage allocated by bootmem. */
305 spin_lock(&map_entries_bootmem_lock);
306 list_del(&entry->list);
307 spin_unlock(&map_entries_bootmem_lock);
308
309 memset(entry, 0, sizeof(*entry));
310 }
311
312 firmware_map_add_entry(start, end, type, entry);
313 /* create the memmap entry */
314 add_sysfs_fw_map_entry(entry);
315
316 return 0;
317}
318
319/**
320 * firmware_map_add_early() - Adds a firmware mapping entry.
321 * @start: Start of the memory range.
322 * @end: End of the memory range.
323 * @type: Type of the memory range.
324 *
325 * Adds a firmware mapping entry. This function uses the bootmem allocator
326 * for memory allocation.
327 *
328 * That function must be called before late_initcall.
329 *
330 * Return: 0 on success, or -ENOMEM if no memory could be allocated.
331 */
332int __init firmware_map_add_early(u64 start, u64 end, const char *type)
333{
334 struct firmware_map_entry *entry;
335
336 entry = memblock_virt_alloc(sizeof(struct firmware_map_entry), 0);
337 if (WARN_ON(!entry))
338 return -ENOMEM;
339
340 return firmware_map_add_entry(start, end, type, entry);
341}
342
343/**
344 * firmware_map_remove() - remove a firmware mapping entry
345 * @start: Start of the memory range.
346 * @end: End of the memory range.
347 * @type: Type of the memory range.
348 *
349 * removes a firmware mapping entry.
350 *
351 * Return: 0 on success, or -EINVAL if no entry.
352 */
353int __meminit firmware_map_remove(u64 start, u64 end, const char *type)
354{
355 struct firmware_map_entry *entry;
356
357 spin_lock(&map_entries_lock);
358 entry = firmware_map_find_entry(start, end - 1, type);
359 if (!entry) {
360 spin_unlock(&map_entries_lock);
361 return -EINVAL;
362 }
363
364 firmware_map_remove_entry(entry);
365 spin_unlock(&map_entries_lock);
366
367 /* remove the memmap entry */
368 remove_sysfs_fw_map_entry(entry);
369
370 return 0;
371}
372
373/*
374 * Sysfs functions -------------------------------------------------------------
375 */
376
377static ssize_t start_show(struct firmware_map_entry *entry, char *buf)
378{
379 return snprintf(buf, PAGE_SIZE, "0x%llx\n",
380 (unsigned long long)entry->start);
381}
382
383static ssize_t end_show(struct firmware_map_entry *entry, char *buf)
384{
385 return snprintf(buf, PAGE_SIZE, "0x%llx\n",
386 (unsigned long long)entry->end);
387}
388
389static ssize_t type_show(struct firmware_map_entry *entry, char *buf)
390{
391 return snprintf(buf, PAGE_SIZE, "%s\n", entry->type);
392}
393
394static inline struct memmap_attribute *to_memmap_attr(struct attribute *attr)
395{
396 return container_of(attr, struct memmap_attribute, attr);
397}
398
399static ssize_t memmap_attr_show(struct kobject *kobj,
400 struct attribute *attr, char *buf)
401{
402 struct firmware_map_entry *entry = to_memmap_entry(kobj);
403 struct memmap_attribute *memmap_attr = to_memmap_attr(attr);
404
405 return memmap_attr->show(entry, buf);
406}
407
408/*
409 * Initialises stuff and adds the entries in the map_entries list to
410 * sysfs. Important is that firmware_map_add() and firmware_map_add_early()
411 * must be called before late_initcall. That's just because that function
412 * is called as late_initcall() function, which means that if you call
413 * firmware_map_add() or firmware_map_add_early() afterwards, the entries
414 * are not added to sysfs.
415 */
416static int __init firmware_memmap_init(void)
417{
418 struct firmware_map_entry *entry;
419
420 list_for_each_entry(entry, &map_entries, list)
421 add_sysfs_fw_map_entry(entry);
422
423 return 0;
424}
425late_initcall(firmware_memmap_init);
426