123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright (C) 2015 Masahiro Yamada <yamada.masahiro@socionext.com>
- *
- * Based on the original work in Linux by
- * Copyright (c) 2006 SUSE Linux Products GmbH
- * Copyright (c) 2006 Tejun Heo <teheo@suse.de>
- */
- #define LOG_CATEGORY LOGC_DEVRES
- #include <common.h>
- #include <malloc.h>
- #include <linux/compat.h>
- #include <linux/kernel.h>
- #include <linux/list.h>
- #include <dm/device.h>
- #include <dm/devres.h>
- #include <dm/root.h>
- #include <dm/util.h>
- /** enum devres_phase - Shows where resource was allocated
- *
- * DEVRES_PHASE_BIND: In the bind() method
- * DEVRES_PHASE_OFDATA: In the ofdata_to_platdata() method
- * DEVRES_PHASE_PROBE: In the probe() method
- */
- enum devres_phase {
- DEVRES_PHASE_BIND,
- DEVRES_PHASE_OFDATA,
- DEVRES_PHASE_PROBE,
- };
- /**
- * struct devres - Bookkeeping info for managed device resource
- * @entry: List to associate this structure with a device
- * @release: Callback invoked when this resource is released
- * @probe: Show where this resource was allocated
- * @name: Name of release function
- * @size: Size of resource data
- * @data: Resource data
- */
- struct devres {
- struct list_head entry;
- dr_release_t release;
- enum devres_phase phase;
- #ifdef CONFIG_DEBUG_DEVRES
- const char *name;
- size_t size;
- #endif
- unsigned long long data[];
- };
- #ifdef CONFIG_DEBUG_DEVRES
- static void set_node_dbginfo(struct devres *dr, const char *name, size_t size)
- {
- dr->name = name;
- dr->size = size;
- }
- static void devres_log(struct udevice *dev, struct devres *dr,
- const char *op)
- {
- log_debug("%s: DEVRES %3s %p %s (%lu bytes)\n", dev->name, op, dr,
- dr->name, (unsigned long)dr->size);
- }
- #else /* CONFIG_DEBUG_DEVRES */
- #define set_node_dbginfo(dr, n, s) do {} while (0)
- #define devres_log(dev, dr, op) do {} while (0)
- #endif
- #if CONFIG_DEBUG_DEVRES
- void *__devres_alloc(dr_release_t release, size_t size, gfp_t gfp,
- const char *name)
- #else
- void *_devres_alloc(dr_release_t release, size_t size, gfp_t gfp)
- #endif
- {
- size_t tot_size = sizeof(struct devres) + size;
- struct devres *dr;
- dr = kmalloc(tot_size, gfp);
- if (unlikely(!dr))
- return NULL;
- INIT_LIST_HEAD(&dr->entry);
- dr->release = release;
- set_node_dbginfo(dr, name, size);
- return dr->data;
- }
- void devres_free(void *res)
- {
- if (res) {
- struct devres *dr = container_of(res, struct devres, data);
- assert_noisy(list_empty(&dr->entry));
- kfree(dr);
- }
- }
- void devres_add(struct udevice *dev, void *res)
- {
- struct devres *dr = container_of(res, struct devres, data);
- devres_log(dev, dr, "ADD");
- assert_noisy(list_empty(&dr->entry));
- if (dev->flags & DM_FLAG_PLATDATA_VALID)
- dr->phase = DEVRES_PHASE_PROBE;
- else if (dev->flags & DM_FLAG_BOUND)
- dr->phase = DEVRES_PHASE_OFDATA;
- else
- dr->phase = DEVRES_PHASE_BIND;
- list_add_tail(&dr->entry, &dev->devres_head);
- }
- void *devres_find(struct udevice *dev, dr_release_t release,
- dr_match_t match, void *match_data)
- {
- struct devres *dr;
- list_for_each_entry_reverse(dr, &dev->devres_head, entry) {
- if (dr->release != release)
- continue;
- if (match && !match(dev, dr->data, match_data))
- continue;
- return dr->data;
- }
- return NULL;
- }
- void *devres_get(struct udevice *dev, void *new_res,
- dr_match_t match, void *match_data)
- {
- struct devres *new_dr = container_of(new_res, struct devres, data);
- void *res;
- res = devres_find(dev, new_dr->release, match, match_data);
- if (!res) {
- devres_add(dev, new_res);
- res = new_res;
- new_res = NULL;
- }
- devres_free(new_res);
- return res;
- }
- void *devres_remove(struct udevice *dev, dr_release_t release,
- dr_match_t match, void *match_data)
- {
- void *res;
- res = devres_find(dev, release, match, match_data);
- if (res) {
- struct devres *dr = container_of(res, struct devres, data);
- list_del_init(&dr->entry);
- devres_log(dev, dr, "REM");
- }
- return res;
- }
- int devres_destroy(struct udevice *dev, dr_release_t release,
- dr_match_t match, void *match_data)
- {
- void *res;
- res = devres_remove(dev, release, match, match_data);
- if (unlikely(!res))
- return -ENOENT;
- devres_free(res);
- return 0;
- }
- int devres_release(struct udevice *dev, dr_release_t release,
- dr_match_t match, void *match_data)
- {
- void *res;
- res = devres_remove(dev, release, match, match_data);
- if (unlikely(!res))
- return -ENOENT;
- (*release)(dev, res);
- devres_free(res);
- return 0;
- }
- static void release_nodes(struct udevice *dev, struct list_head *head,
- bool probe_and_ofdata_only)
- {
- struct devres *dr, *tmp;
- list_for_each_entry_safe_reverse(dr, tmp, head, entry) {
- if (probe_and_ofdata_only && dr->phase == DEVRES_PHASE_BIND)
- break;
- devres_log(dev, dr, "REL");
- dr->release(dev, dr->data);
- list_del(&dr->entry);
- kfree(dr);
- }
- }
- void devres_release_probe(struct udevice *dev)
- {
- release_nodes(dev, &dev->devres_head, true);
- }
- void devres_release_all(struct udevice *dev)
- {
- release_nodes(dev, &dev->devres_head, false);
- }
- #ifdef CONFIG_DEBUG_DEVRES
- static char *const devres_phase_name[] = {"BIND", "OFDATA", "PROBE"};
- static void dump_resources(struct udevice *dev, int depth)
- {
- struct devres *dr;
- struct udevice *child;
- printf("- %s\n", dev->name);
- list_for_each_entry(dr, &dev->devres_head, entry)
- printf(" %p (%lu byte) %s %s\n", dr,
- (unsigned long)dr->size, dr->name,
- devres_phase_name[dr->phase]);
- list_for_each_entry(child, &dev->child_head, sibling_node)
- dump_resources(child, depth + 1);
- }
- void dm_dump_devres(void)
- {
- struct udevice *root;
- root = dm_root();
- if (root)
- dump_resources(root, 0);
- }
- void devres_get_stats(const struct udevice *dev, struct devres_stats *stats)
- {
- struct devres *dr;
- stats->allocs = 0;
- stats->total_size = 0;
- list_for_each_entry(dr, &dev->devres_head, entry) {
- stats->allocs++;
- stats->total_size += dr->size;
- }
- }
- #endif
- /*
- * Managed kmalloc/kfree
- */
- static void devm_kmalloc_release(struct udevice *dev, void *res)
- {
- /* noop */
- }
- static int devm_kmalloc_match(struct udevice *dev, void *res, void *data)
- {
- return res == data;
- }
- void *devm_kmalloc(struct udevice *dev, size_t size, gfp_t gfp)
- {
- void *data;
- data = _devres_alloc(devm_kmalloc_release, size, gfp);
- if (unlikely(!data))
- return NULL;
- devres_add(dev, data);
- return data;
- }
- void devm_kfree(struct udevice *dev, void *p)
- {
- int rc;
- rc = devres_destroy(dev, devm_kmalloc_release, devm_kmalloc_match, p);
- assert_noisy(!rc);
- }
|