4 * Copyright (c) 2013 Google, Inc
7 * Pavel Herrmann <morpheus.ibis@gmail.com>
9 * SPDX-License-Identifier: GPL-2.0+
15 #include <dm/device.h>
16 #include <dm/device-internal.h>
18 #include <dm/platdata.h>
19 #include <dm/uclass.h>
20 #include <dm/uclass-internal.h>
22 #include <linux/err.h>
23 #include <linux/list.h>
25 DECLARE_GLOBAL_DATA_PTR;
28 * device_chld_unbind() - Unbind all device's children from the device
30 * On error, the function continues to unbind all children, and reports the
33 * @dev: The device that is to be stripped of its children
34 * @return 0 on success, -ve on error
36 static int device_chld_unbind(struct udevice *dev)
38 struct udevice *pos, *n;
39 int ret, saved_ret = 0;
43 list_for_each_entry_safe(pos, n, &dev->child_head, sibling_node) {
44 ret = device_unbind(pos);
45 if (ret && !saved_ret)
53 * device_chld_remove() - Stop all device's children
54 * @dev: The device whose children are to be removed
55 * @return 0 on success, -ve on error
57 static int device_chld_remove(struct udevice *dev)
59 struct udevice *pos, *n;
64 list_for_each_entry_safe(pos, n, &dev->child_head, sibling_node) {
65 ret = device_remove(pos);
73 int device_bind(struct udevice *parent, struct driver *drv, const char *name,
74 void *platdata, int of_offset, struct udevice **devp)
84 ret = uclass_get(drv->id, &uc);
88 dev = calloc(1, sizeof(struct udevice));
92 INIT_LIST_HEAD(&dev->sibling_node);
93 INIT_LIST_HEAD(&dev->child_head);
94 INIT_LIST_HEAD(&dev->uclass_node);
95 dev->platdata = platdata;
97 dev->of_offset = of_offset;
103 * For some devices, such as a SPI or I2C bus, the 'reg' property
104 * is a reasonable indicator of the sequence number. But if there is
105 * an alias, we use that in preference. In any case, this is just
106 * a 'requested' sequence, and will be resolved (and ->seq updated)
107 * when the device is probed.
109 dev->req_seq = fdtdec_get_int(gd->fdt_blob, of_offset, "reg", -1);
111 if (uc->uc_drv->name && of_offset != -1) {
112 fdtdec_get_alias_seq(gd->fdt_blob, uc->uc_drv->name, of_offset,
116 if (!dev->platdata && drv->platdata_auto_alloc_size)
117 dev->flags |= DM_FLAG_ALLOC_PDATA;
119 /* put dev into parent's successor list */
121 list_add_tail(&dev->sibling_node, &parent->child_head);
123 ret = uclass_bind_device(dev);
127 /* if we fail to bind we remove device from successors and free it */
129 ret = drv->bind(dev);
131 if (uclass_unbind_device(dev)) {
132 dm_warn("Failed to unbind dev '%s' on error path\n",
139 dm_dbg("Bound device %s to %s\n", dev->name, parent->name);
145 list_del(&dev->sibling_node);
150 int device_bind_by_name(struct udevice *parent, bool pre_reloc_only,
151 const struct driver_info *info, struct udevice **devp)
155 drv = lists_driver_lookup_name(info->name);
158 if (pre_reloc_only && !(drv->flags & DM_FLAG_PRE_RELOC))
161 return device_bind(parent, drv, info->name, (void *)info->platdata,
165 int device_unbind(struct udevice *dev)
173 if (dev->flags & DM_FLAG_ACTIVATED)
180 ret = drv->unbind(dev);
185 ret = device_chld_unbind(dev);
189 ret = uclass_unbind_device(dev);
194 list_del(&dev->sibling_node);
201 * device_free() - Free memory buffers allocated by a device
202 * @dev: Device that is to be started
204 static void device_free(struct udevice *dev)
208 if (dev->driver->priv_auto_alloc_size) {
212 if (dev->flags & DM_FLAG_ALLOC_PDATA) {
214 dev->platdata = NULL;
216 size = dev->uclass->uc_drv->per_device_auto_alloc_size;
218 free(dev->uclass_priv);
219 dev->uclass_priv = NULL;
222 size = dev->parent->driver->per_child_auto_alloc_size;
224 free(dev->parent_priv);
225 dev->parent_priv = NULL;
230 int device_probe(struct udevice *dev)
240 if (dev->flags & DM_FLAG_ACTIVATED)
246 /* Allocate private data and platdata if requested */
247 if (drv->priv_auto_alloc_size) {
248 dev->priv = calloc(1, drv->priv_auto_alloc_size);
254 /* Allocate private data if requested */
255 if (dev->flags & DM_FLAG_ALLOC_PDATA) {
256 dev->platdata = calloc(1, drv->platdata_auto_alloc_size);
257 if (!dev->platdata) {
262 size = dev->uclass->uc_drv->per_device_auto_alloc_size;
264 dev->uclass_priv = calloc(1, size);
265 if (!dev->uclass_priv) {
271 /* Ensure all parents are probed */
273 size = dev->parent->driver->per_child_auto_alloc_size;
275 dev->parent_priv = calloc(1, size);
276 if (!dev->parent_priv) {
282 ret = device_probe(dev->parent);
287 seq = uclass_resolve_seq(dev);
294 if (drv->ofdata_to_platdata && dev->of_offset >= 0) {
295 ret = drv->ofdata_to_platdata(dev);
301 ret = drv->probe(dev);
306 dev->flags |= DM_FLAG_ACTIVATED;
308 ret = uclass_post_probe_device(dev);
310 dev->flags &= ~DM_FLAG_ACTIVATED;
316 if (device_remove(dev)) {
317 dm_warn("%s: Device '%s' failed to remove on error path\n",
318 __func__, dev->name);
327 int device_remove(struct udevice *dev)
335 if (!(dev->flags & DM_FLAG_ACTIVATED))
341 ret = uclass_pre_remove_device(dev);
345 ret = device_chld_remove(dev);
350 ret = drv->remove(dev);
358 dev->flags &= ~DM_FLAG_ACTIVATED;
363 /* We can't put the children back */
364 dm_warn("%s: Device '%s' failed to remove, but children are gone\n",
365 __func__, dev->name);
367 ret = uclass_post_probe_device(dev);
369 dm_warn("%s: Device '%s' failed to post_probe on error path\n",
370 __func__, dev->name);
376 void *dev_get_platdata(struct udevice *dev)
379 dm_warn("%s: null device", __func__);
383 return dev->platdata;
386 void *dev_get_priv(struct udevice *dev)
389 dm_warn("%s: null device", __func__);
396 void *dev_get_parentdata(struct udevice *dev)
399 dm_warn("%s: null device", __func__);
403 return dev->parent_priv;
406 static int device_get_device_tail(struct udevice *dev, int ret,
407 struct udevice **devp)
412 ret = device_probe(dev);
421 int device_get_child(struct udevice *parent, int index, struct udevice **devp)
425 list_for_each_entry(dev, &parent->child_head, sibling_node) {
427 return device_get_device_tail(dev, 0, devp);
433 int device_find_child_by_seq(struct udevice *parent, int seq_or_req_seq,
434 bool find_req_seq, struct udevice **devp)
439 if (seq_or_req_seq == -1)
442 list_for_each_entry(dev, &parent->child_head, sibling_node) {
443 if ((find_req_seq ? dev->req_seq : dev->seq) ==
453 int device_get_child_by_seq(struct udevice *parent, int seq,
454 struct udevice **devp)
460 ret = device_find_child_by_seq(parent, seq, false, &dev);
461 if (ret == -ENODEV) {
463 * We didn't find it in probed devices. See if there is one
464 * that will request this seq if probed.
466 ret = device_find_child_by_seq(parent, seq, true, &dev);
468 return device_get_device_tail(dev, ret, devp);
471 int device_find_child_by_of_offset(struct udevice *parent, int of_offset,
472 struct udevice **devp)
478 list_for_each_entry(dev, &parent->child_head, sibling_node) {
479 if (dev->of_offset == of_offset) {
488 int device_get_child_by_of_offset(struct udevice *parent, int seq,
489 struct udevice **devp)
495 ret = device_find_child_by_of_offset(parent, seq, &dev);
496 return device_get_device_tail(dev, ret, devp);