123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426 |
- #include <linux/string.h>
- #include <linux/firmware-map.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/types.h>
- #include <linux/bootmem.h>
- #include <linux/slab.h>
- #include <linux/mm.h>
- struct firmware_map_entry {
-
- u64 start;
- u64 end;
- const char *type;
- struct list_head list;
- struct kobject kobj;
- };
- static ssize_t memmap_attr_show(struct kobject *kobj,
- struct attribute *attr, char *buf);
- static ssize_t start_show(struct firmware_map_entry *entry, char *buf);
- static ssize_t end_show(struct firmware_map_entry *entry, char *buf);
- static ssize_t type_show(struct firmware_map_entry *entry, char *buf);
- static struct firmware_map_entry * __meminit
- firmware_map_find_entry(u64 start, u64 end, const char *type);
- struct memmap_attribute {
- struct attribute attr;
- ssize_t (*show)(struct firmware_map_entry *entry, char *buf);
- };
- static struct memmap_attribute memmap_start_attr = __ATTR_RO(start);
- static struct memmap_attribute memmap_end_attr = __ATTR_RO(end);
- static struct memmap_attribute memmap_type_attr = __ATTR_RO(type);
- static struct attribute *def_attrs[] = {
- &memmap_start_attr.attr,
- &memmap_end_attr.attr,
- &memmap_type_attr.attr,
- NULL
- };
- static const struct sysfs_ops memmap_attr_ops = {
- .show = memmap_attr_show,
- };
- static LIST_HEAD(map_entries);
- static DEFINE_SPINLOCK(map_entries_lock);
- static LIST_HEAD(map_entries_bootmem);
- static DEFINE_SPINLOCK(map_entries_bootmem_lock);
- static inline struct firmware_map_entry *
- to_memmap_entry(struct kobject *kobj)
- {
- return container_of(kobj, struct firmware_map_entry, kobj);
- }
- static void __meminit release_firmware_map_entry(struct kobject *kobj)
- {
- struct firmware_map_entry *entry = to_memmap_entry(kobj);
- if (PageReserved(virt_to_page(entry))) {
-
- spin_lock(&map_entries_bootmem_lock);
- list_add(&entry->list, &map_entries_bootmem);
- spin_unlock(&map_entries_bootmem_lock);
- return;
- }
- kfree(entry);
- }
- static struct kobj_type __refdata memmap_ktype = {
- .release = release_firmware_map_entry,
- .sysfs_ops = &memmap_attr_ops,
- .default_attrs = def_attrs,
- };
- static int firmware_map_add_entry(u64 start, u64 end,
- const char *type,
- struct firmware_map_entry *entry)
- {
- BUG_ON(start > end);
- entry->start = start;
- entry->end = end - 1;
- entry->type = type;
- INIT_LIST_HEAD(&entry->list);
- kobject_init(&entry->kobj, &memmap_ktype);
- spin_lock(&map_entries_lock);
- list_add_tail(&entry->list, &map_entries);
- spin_unlock(&map_entries_lock);
- return 0;
- }
- static inline void firmware_map_remove_entry(struct firmware_map_entry *entry)
- {
- list_del(&entry->list);
- }
- static int add_sysfs_fw_map_entry(struct firmware_map_entry *entry)
- {
- static int map_entries_nr;
- static struct kset *mmap_kset;
- if (entry->kobj.state_in_sysfs)
- return -EEXIST;
- if (!mmap_kset) {
- mmap_kset = kset_create_and_add("memmap", NULL, firmware_kobj);
- if (!mmap_kset)
- return -ENOMEM;
- }
- entry->kobj.kset = mmap_kset;
- if (kobject_add(&entry->kobj, NULL, "%d", map_entries_nr++))
- kobject_put(&entry->kobj);
- return 0;
- }
- static inline void remove_sysfs_fw_map_entry(struct firmware_map_entry *entry)
- {
- kobject_put(&entry->kobj);
- }
- static struct firmware_map_entry * __meminit
- firmware_map_find_entry_in_list(u64 start, u64 end, const char *type,
- struct list_head *list)
- {
- struct firmware_map_entry *entry;
- list_for_each_entry(entry, list, list)
- if ((entry->start == start) && (entry->end == end) &&
- (!strcmp(entry->type, type))) {
- return entry;
- }
- return NULL;
- }
- static struct firmware_map_entry * __meminit
- firmware_map_find_entry(u64 start, u64 end, const char *type)
- {
- return firmware_map_find_entry_in_list(start, end, type, &map_entries);
- }
- static struct firmware_map_entry * __meminit
- firmware_map_find_entry_bootmem(u64 start, u64 end, const char *type)
- {
- return firmware_map_find_entry_in_list(start, end, type,
- &map_entries_bootmem);
- }
- int __meminit firmware_map_add_hotplug(u64 start, u64 end, const char *type)
- {
- struct firmware_map_entry *entry;
- entry = firmware_map_find_entry(start, end - 1, type);
- if (entry)
- return 0;
- entry = firmware_map_find_entry_bootmem(start, end - 1, type);
- if (!entry) {
- entry = kzalloc(sizeof(struct firmware_map_entry), GFP_ATOMIC);
- if (!entry)
- return -ENOMEM;
- } else {
-
- spin_lock(&map_entries_bootmem_lock);
- list_del(&entry->list);
- spin_unlock(&map_entries_bootmem_lock);
- memset(entry, 0, sizeof(*entry));
- }
- firmware_map_add_entry(start, end, type, entry);
-
- add_sysfs_fw_map_entry(entry);
- return 0;
- }
- int __init firmware_map_add_early(u64 start, u64 end, const char *type)
- {
- struct firmware_map_entry *entry;
- entry = memblock_virt_alloc(sizeof(struct firmware_map_entry), 0);
- if (WARN_ON(!entry))
- return -ENOMEM;
- return firmware_map_add_entry(start, end, type, entry);
- }
- int __meminit firmware_map_remove(u64 start, u64 end, const char *type)
- {
- struct firmware_map_entry *entry;
- spin_lock(&map_entries_lock);
- entry = firmware_map_find_entry(start, end - 1, type);
- if (!entry) {
- spin_unlock(&map_entries_lock);
- return -EINVAL;
- }
- firmware_map_remove_entry(entry);
- spin_unlock(&map_entries_lock);
-
- remove_sysfs_fw_map_entry(entry);
- return 0;
- }
- static ssize_t start_show(struct firmware_map_entry *entry, char *buf)
- {
- return snprintf(buf, PAGE_SIZE, "0x%llx\n",
- (unsigned long long)entry->start);
- }
- static ssize_t end_show(struct firmware_map_entry *entry, char *buf)
- {
- return snprintf(buf, PAGE_SIZE, "0x%llx\n",
- (unsigned long long)entry->end);
- }
- static ssize_t type_show(struct firmware_map_entry *entry, char *buf)
- {
- return snprintf(buf, PAGE_SIZE, "%s\n", entry->type);
- }
- static inline struct memmap_attribute *to_memmap_attr(struct attribute *attr)
- {
- return container_of(attr, struct memmap_attribute, attr);
- }
- static ssize_t memmap_attr_show(struct kobject *kobj,
- struct attribute *attr, char *buf)
- {
- struct firmware_map_entry *entry = to_memmap_entry(kobj);
- struct memmap_attribute *memmap_attr = to_memmap_attr(attr);
- return memmap_attr->show(entry, buf);
- }
- static int __init firmware_memmap_init(void)
- {
- struct firmware_map_entry *entry;
- list_for_each_entry(entry, &map_entries, list)
- add_sysfs_fw_map_entry(entry);
- return 0;
- }
- late_initcall(firmware_memmap_init);
|