2 * Copyright (C) 2015 Masahiro Yamada <yamada.masahiro@socionext.com>
4 * Based on the original work in Linux by
5 * Copyright (c) 2006 SUSE Linux Products GmbH
6 * Copyright (c) 2006 Tejun Heo <teheo@suse.de>
8 * SPDX-License-Identifier: GPL-2.0+
12 #include <linux/compat.h>
13 #include <linux/kernel.h>
14 #include <linux/list.h>
15 #include <dm/device.h>
18 * struct devres - Bookkeeping info for managed device resource
19 * @entry: List to associate this structure with a device
20 * @release: Callback invoked when this resource is released
21 * @probe: Flag to show when this resource was allocated
22 (true = probe, false = bind)
23 * @name: Name of release function
24 * @size: Size of resource data
25 * @data: Resource data
28 struct list_head entry;
31 #ifdef CONFIG_DEBUG_DEVRES
35 unsigned long long data[];
38 #ifdef CONFIG_DEBUG_DEVRES
39 static void set_node_dbginfo(struct devres *dr, const char *name, size_t size)
45 static void devres_log(struct udevice *dev, struct devres *dr,
48 printf("%s: DEVRES %3s %p %s (%lu bytes)\n",
49 dev->name, op, dr, dr->name, (unsigned long)dr->size);
51 #else /* CONFIG_DEBUG_DEVRES */
52 #define set_node_dbginfo(dr, n, s) do {} while (0)
53 #define devres_log(dev, dr, op) do {} while (0)
56 #if CONFIG_DEBUG_DEVRES
57 void *__devres_alloc(dr_release_t release, size_t size, gfp_t gfp,
60 void *_devres_alloc(dr_release_t release, size_t size, gfp_t gfp)
63 size_t tot_size = sizeof(struct devres) + size;
66 dr = kmalloc(tot_size, gfp);
70 INIT_LIST_HEAD(&dr->entry);
71 dr->release = release;
72 set_node_dbginfo(dr, name, size);
77 void devres_free(void *res)
80 struct devres *dr = container_of(res, struct devres, data);
82 BUG_ON(!list_empty(&dr->entry));
87 void devres_add(struct udevice *dev, void *res)
89 struct devres *dr = container_of(res, struct devres, data);
91 devres_log(dev, dr, "ADD");
92 BUG_ON(!list_empty(&dr->entry));
93 dr->probe = dev->flags & DM_FLAG_BOUND ? true : false;
94 list_add_tail(&dr->entry, &dev->devres_head);
97 void *devres_find(struct udevice *dev, dr_release_t release,
98 dr_match_t match, void *match_data)
102 list_for_each_entry_reverse(dr, &dev->devres_head, entry) {
103 if (dr->release != release)
105 if (match && !match(dev, dr->data, match_data))
113 void *devres_get(struct udevice *dev, void *new_res,
114 dr_match_t match, void *match_data)
116 struct devres *new_dr = container_of(new_res, struct devres, data);
119 res = devres_find(dev, new_dr->release, match, match_data);
121 devres_add(dev, new_res);
125 devres_free(new_res);
130 void *devres_remove(struct udevice *dev, dr_release_t release,
131 dr_match_t match, void *match_data)
135 res = devres_find(dev, release, match, match_data);
137 struct devres *dr = container_of(res, struct devres, data);
139 list_del_init(&dr->entry);
140 devres_log(dev, dr, "REM");
146 int devres_destroy(struct udevice *dev, dr_release_t release,
147 dr_match_t match, void *match_data)
151 res = devres_remove(dev, release, match, match_data);
159 int devres_release(struct udevice *dev, dr_release_t release,
160 dr_match_t match, void *match_data)
164 res = devres_remove(dev, release, match, match_data);
168 (*release)(dev, res);
173 static void release_nodes(struct udevice *dev, struct list_head *head,
176 struct devres *dr, *tmp;
178 list_for_each_entry_safe_reverse(dr, tmp, head, entry) {
179 if (probe_only && !dr->probe)
181 devres_log(dev, dr, "REL");
182 dr->release(dev, dr->data);
183 list_del(&dr->entry);
188 void devres_release_probe(struct udevice *dev)
190 release_nodes(dev, &dev->devres_head, true);
193 void devres_release_all(struct udevice *dev)
195 release_nodes(dev, &dev->devres_head, false);
199 * Managed kmalloc/kfree
201 static void devm_kmalloc_release(struct udevice *dev, void *res)
206 static int devm_kmalloc_match(struct udevice *dev, void *res, void *data)
211 void *devm_kmalloc(struct udevice *dev, size_t size, gfp_t gfp)
215 data = _devres_alloc(devm_kmalloc_release, size, gfp);
219 devres_add(dev, data);
224 void devm_kfree(struct udevice *dev, void *p)
228 rc = devres_destroy(dev, devm_kmalloc_release, devm_kmalloc_match, p);