blob: d1098a3861aec3bc2fb8c63a88a63f4f6b9a4b0f [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Simon Glassdd6ab882014-02-26 15:59:18 -07002/*
3 * Device manager
4 *
5 * Copyright (c) 2013 Google, Inc
6 *
7 * (C) Copyright 2012
8 * Pavel Herrmann <morpheus.ibis@gmail.com>
Simon Glassdd6ab882014-02-26 15:59:18 -07009 */
10
11#include <common.h>
Simon Glass63334482019-11-14 12:57:39 -070012#include <cpu_func.h>
Simon Glass0f2af882020-05-10 11:40:05 -060013#include <log.h>
Simon Glass3ba929a2020-10-30 21:38:53 -060014#include <asm/global_data.h>
Vignesh R0dff3702016-07-06 09:58:55 +053015#include <asm/io.h>
Philipp Tomsich9cf03b02018-01-08 13:59:18 +010016#include <clk.h>
Simon Glassdb6f0202014-07-23 06:55:12 -060017#include <fdtdec.h>
Stefan Roeseadc09052015-09-02 07:41:12 +020018#include <fdt_support.h>
Simon Glassdd6ab882014-02-26 15:59:18 -070019#include <malloc.h>
Simon Glass274e0b02020-05-10 11:39:56 -060020#include <asm/cache.h>
Simon Glassdd6ab882014-02-26 15:59:18 -070021#include <dm/device.h>
22#include <dm/device-internal.h>
23#include <dm/lists.h>
Mario Six1f1c1ec2018-01-15 11:07:20 +010024#include <dm/of_access.h>
Masahiro Yamadaf8efa632015-08-27 12:44:29 +090025#include <dm/pinctrl.h>
Simon Glassdd6ab882014-02-26 15:59:18 -070026#include <dm/platdata.h>
Simon Glass322b2902017-05-18 20:09:05 -060027#include <dm/read.h>
Simon Glassdd6ab882014-02-26 15:59:18 -070028#include <dm/uclass.h>
29#include <dm/uclass-internal.h>
30#include <dm/util.h>
31#include <linux/err.h>
32#include <linux/list.h>
Peng Fan6fba32d2018-07-27 10:20:38 +080033#include <power-domain.h>
Simon Glassdd6ab882014-02-26 15:59:18 -070034
Simon Glassdb6f0202014-07-23 06:55:12 -060035DECLARE_GLOBAL_DATA_PTR;
36
Stephen Warren8c93df12016-05-11 15:26:24 -060037static int device_bind_common(struct udevice *parent, const struct driver *drv,
Simon Glass71fa5b42020-12-03 16:55:18 -070038 const char *name, void *plat,
Simon Glassb0cf4b32017-05-17 17:18:11 -060039 ulong driver_data, ofnode node,
Simon Glass39edb952020-12-03 16:55:19 -070040 uint of_plat_size, struct udevice **devp)
Simon Glassdd6ab882014-02-26 15:59:18 -070041{
Heiko Schocherb74fcb42014-05-22 12:43:05 +020042 struct udevice *dev;
Simon Glassdd6ab882014-02-26 15:59:18 -070043 struct uclass *uc;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +020044 int size, ret = 0;
Simon Glass7272e922020-12-16 21:20:09 -070045 bool auto_seq = true;
Simon Glass2543b162020-12-22 19:30:29 -070046 void *ptr;
Simon Glassdd6ab882014-02-26 15:59:18 -070047
Masahiro Yamadae1cc1f02015-08-27 12:44:28 +090048 if (devp)
49 *devp = NULL;
Simon Glassdd6ab882014-02-26 15:59:18 -070050 if (!name)
51 return -EINVAL;
52
53 ret = uclass_get(drv->id, &uc);
Simon Glass43313de2015-08-30 16:55:16 -060054 if (ret) {
55 debug("Missing uclass for driver %s\n", drv->name);
Simon Glassdd6ab882014-02-26 15:59:18 -070056 return ret;
Simon Glass43313de2015-08-30 16:55:16 -060057 }
Simon Glassdd6ab882014-02-26 15:59:18 -070058
Heiko Schocherb74fcb42014-05-22 12:43:05 +020059 dev = calloc(1, sizeof(struct udevice));
Simon Glassdd6ab882014-02-26 15:59:18 -070060 if (!dev)
61 return -ENOMEM;
62
63 INIT_LIST_HEAD(&dev->sibling_node);
64 INIT_LIST_HEAD(&dev->child_head);
65 INIT_LIST_HEAD(&dev->uclass_node);
Masahiro Yamada029bfca2015-07-25 21:52:37 +090066#ifdef CONFIG_DEVRES
Masahiro Yamada8b15b162015-07-25 21:52:35 +090067 INIT_LIST_HEAD(&dev->devres_head);
Masahiro Yamada029bfca2015-07-25 21:52:37 +090068#endif
Simon Glass2543b162020-12-22 19:30:29 -070069 dev_set_plat(dev, plat);
Stephen Warren8c93df12016-05-11 15:26:24 -060070 dev->driver_data = driver_data;
Simon Glassdd6ab882014-02-26 15:59:18 -070071 dev->name = name;
Simon Glassa7ece582020-12-19 10:40:14 -070072 dev_set_ofnode(dev, node);
Simon Glassdd6ab882014-02-26 15:59:18 -070073 dev->parent = parent;
74 dev->driver = drv;
75 dev->uclass = uc;
Simon Glassdb6f0202014-07-23 06:55:12 -060076
Simon Glass5e349922020-12-19 10:40:09 -070077 dev->seq_ = -1;
Jean-Jacques Hiblota5da3002018-12-07 14:50:39 +010078 if (CONFIG_IS_ENABLED(DM_SEQ_ALIAS) &&
79 (uc->uc_drv->flags & DM_UC_FLAG_SEQ_ALIAS)) {
Simon Glass1bd3deb2015-02-27 22:06:30 -070080 /*
Stefan Roese9d4ce6b2016-03-16 09:58:01 +010081 * Some devices, such as a SPI bus, I2C bus and serial ports
82 * are numbered using aliases.
Stefan Roese9d4ce6b2016-03-16 09:58:01 +010083 */
Simon Glasse422f8c2020-07-09 18:39:24 -060084 if (CONFIG_IS_ENABLED(OF_CONTROL) &&
85 !CONFIG_IS_ENABLED(OF_PLATDATA)) {
Simon Glass7272e922020-12-16 21:20:09 -070086 if (uc->uc_drv->name && ofnode_valid(node)) {
Simon Glass5e349922020-12-19 10:40:09 -070087 if (!dev_read_alias_seq(dev, &dev->seq_))
Simon Glass38040a92020-12-16 21:20:32 -070088 auto_seq = false;
Simon Glass7272e922020-12-16 21:20:09 -070089 }
Simon Glass0ccb0972015-01-25 08:27:05 -070090 }
Simon Glassdb6f0202014-07-23 06:55:12 -060091 }
Simon Glass3a9d5f12020-12-16 21:20:17 -070092 if (auto_seq && !(uc->uc_drv->flags & DM_UC_FLAG_NO_AUTO_SEQ))
Simon Glass5e349922020-12-19 10:40:09 -070093 dev->seq_ = uclass_find_next_free_seq(uc);
Simon Glass1bd3deb2015-02-27 22:06:30 -070094
Simon Glass41280b52021-03-07 17:34:37 -070095 /* Check if we need to allocate plat */
Simon Glass71fa5b42020-12-03 16:55:18 -070096 if (drv->plat_auto) {
97 bool alloc = !plat;
Simon Glassafbf9b82016-07-04 11:58:18 -060098
Simon Glass41280b52021-03-07 17:34:37 -070099 /*
100 * For of-platdata, we try use the existing data, but if
101 * plat_auto is larger, we must allocate a new space
102 */
Simon Glassafbf9b82016-07-04 11:58:18 -0600103 if (CONFIG_IS_ENABLED(OF_PLATDATA)) {
Simon Glass41280b52021-03-07 17:34:37 -0700104 if (of_plat_size)
Simon Glass6211d762020-12-19 10:40:10 -0700105 dev_or_flags(dev, DM_FLAG_OF_PLATDATA);
Simon Glass41280b52021-03-07 17:34:37 -0700106 if (of_plat_size < drv->plat_auto)
107 alloc = true;
Simon Glassafbf9b82016-07-04 11:58:18 -0600108 }
109 if (alloc) {
Simon Glass6211d762020-12-19 10:40:10 -0700110 dev_or_flags(dev, DM_FLAG_ALLOC_PDATA);
Simon Glass2543b162020-12-22 19:30:29 -0700111 ptr = calloc(1, drv->plat_auto);
112 if (!ptr) {
Simon Glassafbf9b82016-07-04 11:58:18 -0600113 ret = -ENOMEM;
114 goto fail_alloc1;
115 }
Simon Glass41280b52021-03-07 17:34:37 -0700116
117 /*
118 * For of-platdata, copy the old plat into the new
119 * space
120 */
Simon Glass2543b162020-12-22 19:30:29 -0700121 if (CONFIG_IS_ENABLED(OF_PLATDATA) && plat)
122 memcpy(ptr, plat, of_plat_size);
123 dev_set_plat(dev, ptr);
Simon Glassba750492015-01-25 08:27:00 -0700124 }
125 }
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200126
Simon Glass71fa5b42020-12-03 16:55:18 -0700127 size = uc->uc_drv->per_device_plat_auto;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200128 if (size) {
Simon Glass6211d762020-12-19 10:40:10 -0700129 dev_or_flags(dev, DM_FLAG_ALLOC_UCLASS_PDATA);
Simon Glass2543b162020-12-22 19:30:29 -0700130 ptr = calloc(1, size);
131 if (!ptr) {
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200132 ret = -ENOMEM;
133 goto fail_alloc2;
134 }
Simon Glass2543b162020-12-22 19:30:29 -0700135 dev_set_uclass_plat(dev, ptr);
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200136 }
Simon Glass11b61732015-01-25 08:27:01 -0700137
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200138 if (parent) {
Simon Glass71fa5b42020-12-03 16:55:18 -0700139 size = parent->driver->per_child_plat_auto;
Simon Glass57f95402015-01-25 08:27:02 -0700140 if (!size) {
Simon Glass71fa5b42020-12-03 16:55:18 -0700141 size = parent->uclass->uc_drv->per_child_plat_auto;
Simon Glass57f95402015-01-25 08:27:02 -0700142 }
Simon Glass11b61732015-01-25 08:27:01 -0700143 if (size) {
Simon Glass6211d762020-12-19 10:40:10 -0700144 dev_or_flags(dev, DM_FLAG_ALLOC_PARENT_PDATA);
Simon Glass2543b162020-12-22 19:30:29 -0700145 ptr = calloc(1, size);
146 if (!ptr) {
Simon Glass11b61732015-01-25 08:27:01 -0700147 ret = -ENOMEM;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200148 goto fail_alloc3;
Simon Glass11b61732015-01-25 08:27:01 -0700149 }
Simon Glass2543b162020-12-22 19:30:29 -0700150 dev_set_parent_plat(dev, ptr);
Simon Glass11b61732015-01-25 08:27:01 -0700151 }
Heinrich Schuchardt5246b372020-02-15 21:38:48 +0100152 /* put dev into parent's successor list */
Simon Glassdd6ab882014-02-26 15:59:18 -0700153 list_add_tail(&dev->sibling_node, &parent->child_head);
Heinrich Schuchardt5246b372020-02-15 21:38:48 +0100154 }
Simon Glassdd6ab882014-02-26 15:59:18 -0700155
156 ret = uclass_bind_device(dev);
157 if (ret)
Simon Glass4ebe01b2015-01-25 08:26:59 -0700158 goto fail_uclass_bind;
Simon Glassdd6ab882014-02-26 15:59:18 -0700159
160 /* if we fail to bind we remove device from successors and free it */
161 if (drv->bind) {
162 ret = drv->bind(dev);
Simon Glass4ebe01b2015-01-25 08:26:59 -0700163 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700164 goto fail_bind;
Simon Glassdd6ab882014-02-26 15:59:18 -0700165 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700166 if (parent && parent->driver->child_post_bind) {
167 ret = parent->driver->child_post_bind(dev);
168 if (ret)
169 goto fail_child_post_bind;
170 }
Simon Glass286863d2016-01-05 09:30:59 -0700171 if (uc->uc_drv->post_bind) {
172 ret = uc->uc_drv->post_bind(dev);
173 if (ret)
174 goto fail_uclass_post_bind;
175 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700176
Simon Glassdd6ab882014-02-26 15:59:18 -0700177 if (parent)
Masahiro Yamadaf70f39f2017-09-29 12:31:20 +0900178 pr_debug("Bound device %s to %s\n", dev->name, parent->name);
Masahiro Yamadae1cc1f02015-08-27 12:44:28 +0900179 if (devp)
180 *devp = dev;
Simon Glassdd6ab882014-02-26 15:59:18 -0700181
Simon Glass6211d762020-12-19 10:40:10 -0700182 dev_or_flags(dev, DM_FLAG_BOUND);
Masahiro Yamadabdbb5dd2015-07-25 21:52:34 +0900183
Simon Glassdd6ab882014-02-26 15:59:18 -0700184 return 0;
185
Simon Glass286863d2016-01-05 09:30:59 -0700186fail_uclass_post_bind:
187 /* There is no child unbind() method, so no clean-up required */
Simon Glassa4a51a02015-01-25 08:27:03 -0700188fail_child_post_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900189 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700190 if (drv->unbind && drv->unbind(dev)) {
191 dm_warn("unbind() method failed on dev '%s' on error path\n",
192 dev->name);
193 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700194 }
195
Simon Glassdd6ab882014-02-26 15:59:18 -0700196fail_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900197 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700198 if (uclass_unbind_device(dev)) {
199 dm_warn("Failed to unbind dev '%s' on error path\n",
200 dev->name);
201 }
Simon Glass4ebe01b2015-01-25 08:26:59 -0700202 }
203fail_uclass_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900204 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700205 list_del(&dev->sibling_node);
Simon Glass6211d762020-12-19 10:40:10 -0700206 if (dev_get_flags(dev) & DM_FLAG_ALLOC_PARENT_PDATA) {
Simon Glass2543b162020-12-22 19:30:29 -0700207 free(dev_get_parent_plat(dev));
208 dev_set_parent_plat(dev, NULL);
Simon Glasse70a4f42015-02-27 22:06:33 -0700209 }
Simon Glass11b61732015-01-25 08:27:01 -0700210 }
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200211fail_alloc3:
Simon Glass6211d762020-12-19 10:40:10 -0700212 if (dev_get_flags(dev) & DM_FLAG_ALLOC_UCLASS_PDATA) {
Simon Glass2543b162020-12-22 19:30:29 -0700213 free(dev_get_uclass_plat(dev));
214 dev_set_uclass_plat(dev, NULL);
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200215 }
Simon Glass11b61732015-01-25 08:27:01 -0700216fail_alloc2:
Simon Glass6211d762020-12-19 10:40:10 -0700217 if (dev_get_flags(dev) & DM_FLAG_ALLOC_PDATA) {
Simon Glass2543b162020-12-22 19:30:29 -0700218 free(dev_get_plat(dev));
219 dev_set_plat(dev, NULL);
Simon Glassba750492015-01-25 08:27:00 -0700220 }
221fail_alloc1:
Masahiro Yamada8b15b162015-07-25 21:52:35 +0900222 devres_release_all(dev);
223
Simon Glassdd6ab882014-02-26 15:59:18 -0700224 free(dev);
Simon Glass4ebe01b2015-01-25 08:26:59 -0700225
Simon Glassdd6ab882014-02-26 15:59:18 -0700226 return ret;
227}
228
Stephen Warren8c93df12016-05-11 15:26:24 -0600229int device_bind_with_driver_data(struct udevice *parent,
230 const struct driver *drv, const char *name,
Simon Glass322b2902017-05-18 20:09:05 -0600231 ulong driver_data, ofnode node,
Stephen Warren8c93df12016-05-11 15:26:24 -0600232 struct udevice **devp)
233{
Simon Glass322b2902017-05-18 20:09:05 -0600234 return device_bind_common(parent, drv, name, NULL, driver_data, node,
235 0, devp);
Stephen Warren8c93df12016-05-11 15:26:24 -0600236}
237
Simon Glass884870f2020-11-28 17:50:01 -0700238int device_bind(struct udevice *parent, const struct driver *drv,
Simon Glass71fa5b42020-12-03 16:55:18 -0700239 const char *name, void *plat, ofnode node,
Simon Glass884870f2020-11-28 17:50:01 -0700240 struct udevice **devp)
Simon Glass9eb151e2018-06-11 13:07:15 -0600241{
Simon Glass71fa5b42020-12-03 16:55:18 -0700242 return device_bind_common(parent, drv, name, plat, 0, node, 0,
Simon Glass9eb151e2018-06-11 13:07:15 -0600243 devp);
244}
245
Simon Glassfef72b72014-07-23 06:55:03 -0600246int device_bind_by_name(struct udevice *parent, bool pre_reloc_only,
Simon Glasscfd6a002020-10-03 11:31:33 -0600247 const struct driver_info *info, struct udevice **devp)
Simon Glassdd6ab882014-02-26 15:59:18 -0700248{
249 struct driver *drv;
Simon Glass39edb952020-12-03 16:55:19 -0700250 uint plat_size = 0;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300251 int ret;
Simon Glassdd6ab882014-02-26 15:59:18 -0700252
253 drv = lists_driver_lookup_name(info->name);
254 if (!drv)
255 return -ENOENT;
Simon Glassfef72b72014-07-23 06:55:03 -0600256 if (pre_reloc_only && !(drv->flags & DM_FLAG_PRE_RELOC))
257 return -EPERM;
Simon Glassdd6ab882014-02-26 15:59:18 -0700258
Simon Glassafbf9b82016-07-04 11:58:18 -0600259#if CONFIG_IS_ENABLED(OF_PLATDATA)
Simon Glass39edb952020-12-03 16:55:19 -0700260 plat_size = info->plat_size;
Simon Glassafbf9b82016-07-04 11:58:18 -0600261#endif
Simon Glass71fa5b42020-12-03 16:55:18 -0700262 ret = device_bind_common(parent, drv, info->name, (void *)info->plat, 0,
Simon Glass39edb952020-12-03 16:55:19 -0700263 ofnode_null(), plat_size, devp);
Walter Lozanoffc41b02020-06-25 01:10:11 -0300264 if (ret)
265 return ret;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300266
267 return ret;
Simon Glassdd6ab882014-02-26 15:59:18 -0700268}
269
Claudiu Bezneabf5b8232020-09-07 17:46:33 +0300270int device_reparent(struct udevice *dev, struct udevice *new_parent)
271{
272 struct udevice *pos, *n;
273
274 assert(dev);
275 assert(new_parent);
276
277 list_for_each_entry_safe(pos, n, &dev->parent->child_head,
278 sibling_node) {
279 if (pos->driver != dev->driver)
280 continue;
281
282 list_del(&dev->sibling_node);
283 list_add_tail(&dev->sibling_node, &new_parent->child_head);
284 dev->parent = new_parent;
285
286 break;
287 }
288
289 return 0;
290}
291
Simon Glass825d3f92015-03-25 12:21:53 -0600292static void *alloc_priv(int size, uint flags)
293{
294 void *priv;
295
296 if (flags & DM_FLAG_ALLOC_PRIV_DMA) {
Faiz Abbas03020a92017-09-19 16:53:50 +0530297 size = ROUND(size, ARCH_DMA_MINALIGN);
Simon Glass825d3f92015-03-25 12:21:53 -0600298 priv = memalign(ARCH_DMA_MINALIGN, size);
Simon Glass27bc9b12017-04-04 13:00:19 -0600299 if (priv) {
Simon Glass825d3f92015-03-25 12:21:53 -0600300 memset(priv, '\0', size);
Simon Glass27bc9b12017-04-04 13:00:19 -0600301
302 /*
303 * Ensure that the zero bytes are flushed to memory.
304 * This prevents problems if the driver uses this as
305 * both an input and an output buffer:
306 *
307 * 1. Zeroes written to buffer (here) and sit in the
308 * cache
309 * 2. Driver issues a read command to DMA
310 * 3. CPU runs out of cache space and evicts some cache
311 * data in the buffer, writing zeroes to RAM from
312 * the memset() above
313 * 4. DMA completes
314 * 5. Buffer now has some DMA data and some zeroes
315 * 6. Data being read is now incorrect
316 *
317 * To prevent this, ensure that the cache is clean
318 * within this range at the start. The driver can then
319 * use normal flush-after-write, invalidate-before-read
320 * procedures.
321 *
322 * TODO(sjg@chromium.org): Drop this microblaze
323 * exception.
324 */
325#ifndef CONFIG_MICROBLAZE
326 flush_dcache_range((ulong)priv, (ulong)priv + size);
327#endif
328 }
Simon Glass825d3f92015-03-25 12:21:53 -0600329 } else {
330 priv = calloc(1, size);
331 }
332
333 return priv;
334}
335
Simon Glassad337e62020-12-19 10:40:08 -0700336/**
337 * device_alloc_priv() - Allocate priv/plat data required by the device
338 *
339 * @dev: Device to process
340 * @return 0 if OK, -ENOMEM if out of memory
341 */
342static int device_alloc_priv(struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700343{
Simon Glassa626dff2015-03-25 12:21:54 -0600344 const struct driver *drv;
Simon Glass2543b162020-12-22 19:30:29 -0700345 void *ptr;
Simon Glassad337e62020-12-19 10:40:08 -0700346 int size;
Simon Glass44c47892020-04-05 15:38:19 -0600347
Simon Glassdd6ab882014-02-26 15:59:18 -0700348 drv = dev->driver;
349 assert(drv);
350
Bin Meng82cdd782015-08-24 01:14:02 -0700351 /* Allocate private data if requested and not reentered */
Simon Glass2543b162020-12-22 19:30:29 -0700352 if (drv->priv_auto && !dev_get_priv(dev)) {
353 ptr = alloc_priv(drv->priv_auto, drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700354 if (!ptr)
355 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700356 dev_set_priv(dev, ptr);
Simon Glassdd6ab882014-02-26 15:59:18 -0700357 }
Simon Glassad337e62020-12-19 10:40:08 -0700358
Bin Meng82cdd782015-08-24 01:14:02 -0700359 /* Allocate private data if requested and not reentered */
Simon Glass8a2b47f2020-12-03 16:55:17 -0700360 size = dev->uclass->uc_drv->per_device_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700361 if (size && !dev_get_uclass_priv(dev)) {
362 ptr = alloc_priv(size, dev->uclass->uc_drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700363 if (!ptr)
364 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700365 dev_set_uclass_priv(dev, ptr);
Simon Glassdd6ab882014-02-26 15:59:18 -0700366 }
367
Simon Glassa8d8f162019-12-29 21:19:18 -0700368 /* Allocate parent data for this child */
Simon Glassdd6ab882014-02-26 15:59:18 -0700369 if (dev->parent) {
Simon Glass8a2b47f2020-12-03 16:55:17 -0700370 size = dev->parent->driver->per_child_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700371 if (!size)
Simon Glass8a2b47f2020-12-03 16:55:17 -0700372 size = dev->parent->uclass->uc_drv->per_child_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700373 if (size && !dev_get_parent_priv(dev)) {
374 ptr = alloc_priv(size, drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700375 if (!ptr)
376 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700377 dev_set_parent_priv(dev, ptr);
Simon Glass60d971b2014-07-23 06:55:20 -0600378 }
Simon Glassa8d8f162019-12-29 21:19:18 -0700379 }
380
Simon Glassad337e62020-12-19 10:40:08 -0700381 return 0;
382}
383
384int device_of_to_plat(struct udevice *dev)
385{
386 const struct driver *drv;
387 int ret;
388
389 if (!dev)
390 return -EINVAL;
391
Simon Glass6211d762020-12-19 10:40:10 -0700392 if (dev_get_flags(dev) & DM_FLAG_PLATDATA_VALID)
Simon Glassad337e62020-12-19 10:40:08 -0700393 return 0;
394
395 /* Ensure all parents have ofdata */
396 if (dev->parent) {
397 ret = device_of_to_plat(dev->parent);
398 if (ret)
399 goto fail;
400
401 /*
402 * The device might have already been probed during
403 * the call to device_probe() on its parent device
404 * (e.g. PCI bridge devices). Test the flags again
405 * so that we don't mess up the device.
406 */
Simon Glass6211d762020-12-19 10:40:10 -0700407 if (dev_get_flags(dev) & DM_FLAG_PLATDATA_VALID)
Simon Glassad337e62020-12-19 10:40:08 -0700408 return 0;
409 }
410
411 ret = device_alloc_priv(dev);
412 if (ret)
413 goto fail;
414
415 drv = dev->driver;
416 assert(drv);
417
Simon Glassaad29ae2020-12-03 16:55:21 -0700418 if (drv->of_to_plat &&
Simon Glass07c17772020-12-19 10:40:12 -0700419 (CONFIG_IS_ENABLED(OF_PLATDATA) || dev_has_ofnode(dev))) {
Simon Glassaad29ae2020-12-03 16:55:21 -0700420 ret = drv->of_to_plat(dev);
Simon Glassa8d8f162019-12-29 21:19:18 -0700421 if (ret)
422 goto fail;
423 }
Simon Glass60d971b2014-07-23 06:55:20 -0600424
Simon Glass6211d762020-12-19 10:40:10 -0700425 dev_or_flags(dev, DM_FLAG_PLATDATA_VALID);
Simon Glassd3c9d302019-12-29 21:19:21 -0700426
Simon Glass4a263852019-12-29 21:19:20 -0700427 return 0;
428fail:
429 device_free(dev);
430
431 return ret;
432}
433
Nicolas Saenz Juliennea2c7ead2021-01-12 13:55:24 +0100434/**
435 * device_get_dma_constraints() - Populate device's DMA constraints
436 *
437 * Gets a device's DMA constraints from firmware. This information is later
438 * used by drivers to translate physcal addresses to the device's bus address
439 * space. For now only device-tree is supported.
440 *
441 * @dev: Pointer to target device
442 * Return: 0 if OK or if no DMA constraints were found, error otherwise
443 */
444static int device_get_dma_constraints(struct udevice *dev)
445{
446 struct udevice *parent = dev->parent;
447 phys_addr_t cpu = 0;
448 dma_addr_t bus = 0;
449 u64 size = 0;
450 int ret;
451
452 if (!CONFIG_IS_ENABLED(DM_DMA) || !parent || !dev_has_ofnode(parent))
453 return 0;
454
455 /*
456 * We start parsing for dma-ranges from the device's bus node. This is
457 * specially important on nested buses.
458 */
459 ret = dev_get_dma_range(parent, &cpu, &bus, &size);
460 /* Don't return an error if no 'dma-ranges' were found */
461 if (ret && ret != -ENOENT) {
462 dm_warn("%s: failed to get DMA range, %d\n", dev->name, ret);
463 return ret;
464 }
465
466 dev_set_dma_offset(dev, cpu - bus);
467
468 return 0;
469}
470
Simon Glass4a263852019-12-29 21:19:20 -0700471int device_probe(struct udevice *dev)
472{
473 const struct driver *drv;
474 int ret;
Simon Glass4a263852019-12-29 21:19:20 -0700475
476 if (!dev)
477 return -EINVAL;
478
Simon Glass6211d762020-12-19 10:40:10 -0700479 if (dev_get_flags(dev) & DM_FLAG_ACTIVATED)
Simon Glass4a263852019-12-29 21:19:20 -0700480 return 0;
481
482 drv = dev->driver;
483 assert(drv);
484
Simon Glassaad29ae2020-12-03 16:55:21 -0700485 ret = device_of_to_plat(dev);
Simon Glass4a263852019-12-29 21:19:20 -0700486 if (ret)
487 goto fail;
488
Simon Glassa8d8f162019-12-29 21:19:18 -0700489 /* Ensure all parents are probed */
490 if (dev->parent) {
Simon Glassdd6ab882014-02-26 15:59:18 -0700491 ret = device_probe(dev->parent);
492 if (ret)
493 goto fail;
Bin Meng82cdd782015-08-24 01:14:02 -0700494
495 /*
496 * The device might have already been probed during
497 * the call to device_probe() on its parent device
498 * (e.g. PCI bridge devices). Test the flags again
499 * so that we don't mess up the device.
500 */
Simon Glass6211d762020-12-19 10:40:10 -0700501 if (dev_get_flags(dev) & DM_FLAG_ACTIVATED)
Bin Meng82cdd782015-08-24 01:14:02 -0700502 return 0;
Simon Glassdd6ab882014-02-26 15:59:18 -0700503 }
Simon Glassdb6f0202014-07-23 06:55:12 -0600504
Simon Glass6211d762020-12-19 10:40:10 -0700505 dev_or_flags(dev, DM_FLAG_ACTIVATED);
Simon Glass8b04e732015-03-25 12:21:56 -0600506
Simon Glassbb53bda2015-09-12 08:45:19 -0600507 /*
508 * Process pinctrl for everything except the root device, and
Simon Glass27ce9622016-01-21 19:43:25 -0700509 * continue regardless of the result of pinctrl. Don't process pinctrl
510 * settings for pinctrl devices since the device may not yet be
511 * probed.
Simon Glass303c3c22021-01-21 13:57:13 -0700512 *
513 * This call can produce some non-intuitive results. For example, on an
514 * x86 device where dev is the main PCI bus, the pinctrl device may be
515 * child or grandchild of that bus, meaning that the child will be
516 * probed here. If the child happens to be the P2SB and the pinctrl
517 * device is a child of that, then both the pinctrl and P2SB will be
518 * probed by this call. This works because the DM_FLAG_ACTIVATED flag
519 * is set just above. However, the PCI bus' probe() method and
520 * associated uclass methods have not yet been called.
Simon Glassbb53bda2015-09-12 08:45:19 -0600521 */
Simon Glass27ce9622016-01-21 19:43:25 -0700522 if (dev->parent && device_get_uclass_id(dev) != UCLASS_PINCTRL)
Simon Glassbb53bda2015-09-12 08:45:19 -0600523 pinctrl_select_state(dev, "default");
Masahiro Yamadaf8efa632015-08-27 12:44:29 +0900524
Anatolij Gustschin63a34672019-07-14 21:11:01 +0200525 if (CONFIG_IS_ENABLED(POWER_DOMAIN) && dev->parent &&
Lokesh Vutlac10e52b2019-09-27 13:48:12 +0530526 (device_get_uclass_id(dev) != UCLASS_POWER_DOMAIN) &&
527 !(drv->flags & DM_FLAG_DEFAULT_PD_CTRL_OFF)) {
Peng Fand2201112019-09-17 09:29:22 +0000528 ret = dev_power_domain_on(dev);
529 if (ret)
530 goto fail;
Peng Fan6fba32d2018-07-27 10:20:38 +0800531 }
532
Nicolas Saenz Juliennea2c7ead2021-01-12 13:55:24 +0100533 ret = device_get_dma_constraints(dev);
534 if (ret)
535 goto fail;
536
Simon Glass9c1f3822015-03-05 12:25:22 -0700537 ret = uclass_pre_probe_device(dev);
Simon Glass5104b982015-01-25 08:27:10 -0700538 if (ret)
539 goto fail;
540
Simon Glassd45560d2014-07-23 06:55:21 -0600541 if (dev->parent && dev->parent->driver->child_pre_probe) {
542 ret = dev->parent->driver->child_pre_probe(dev);
543 if (ret)
544 goto fail;
545 }
546
Bin Meng513cf402019-07-05 09:23:16 -0700547 /* Only handle devices that have a valid ofnode */
Simon Glassf1d50f72020-12-19 10:40:13 -0700548 if (dev_has_ofnode(dev)) {
Bin Meng513cf402019-07-05 09:23:16 -0700549 /*
550 * Process 'assigned-{clocks/clock-parents/clock-rates}'
551 * properties
552 */
Jean-Jacques Hiblot9601f322019-10-22 14:00:06 +0200553 ret = clk_set_defaults(dev, 0);
Bin Meng513cf402019-07-05 09:23:16 -0700554 if (ret)
555 goto fail;
556 }
Philipp Tomsich9cf03b02018-01-08 13:59:18 +0100557
Simon Glassdd6ab882014-02-26 15:59:18 -0700558 if (drv->probe) {
559 ret = drv->probe(dev);
Simon Glass9046dec2019-12-29 21:19:16 -0700560 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700561 goto fail;
562 }
563
Simon Glassdd6ab882014-02-26 15:59:18 -0700564 ret = uclass_post_probe_device(dev);
Simon Glass8b04e732015-03-25 12:21:56 -0600565 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700566 goto fail_uclass;
Simon Glassdd6ab882014-02-26 15:59:18 -0700567
Peng Fan7cf58dd2016-03-12 13:17:38 +0800568 if (dev->parent && device_get_uclass_id(dev) == UCLASS_PINCTRL)
569 pinctrl_select_state(dev, "default");
570
Simon Glassdd6ab882014-02-26 15:59:18 -0700571 return 0;
572fail_uclass:
Stefan Roese80b5bc92017-03-20 12:51:48 +0100573 if (device_remove(dev, DM_REMOVE_NORMAL)) {
Simon Glassdd6ab882014-02-26 15:59:18 -0700574 dm_warn("%s: Device '%s' failed to remove on error path\n",
575 __func__, dev->name);
576 }
577fail:
Simon Glass6211d762020-12-19 10:40:10 -0700578 dev_bic_flags(dev, DM_FLAG_ACTIVATED);
Simon Glass8b04e732015-03-25 12:21:56 -0600579
Simon Glassdd6ab882014-02-26 15:59:18 -0700580 device_free(dev);
581
582 return ret;
583}
584
Simon Glassfa20e932020-12-03 16:55:20 -0700585void *dev_get_plat(const struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700586{
587 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700588 dm_warn("%s: null device\n", __func__);
Simon Glassdd6ab882014-02-26 15:59:18 -0700589 return NULL;
590 }
591
Simon Glass541f62c2020-12-22 19:30:30 -0700592 return dev->plat_;
Simon Glassdd6ab882014-02-26 15:59:18 -0700593}
594
Simon Glass71fa5b42020-12-03 16:55:18 -0700595void *dev_get_parent_plat(const struct udevice *dev)
Simon Glass11b61732015-01-25 08:27:01 -0700596{
597 if (!dev) {
Simon Glasscdfc5052015-07-06 16:47:40 -0600598 dm_warn("%s: null device\n", __func__);
Simon Glass11b61732015-01-25 08:27:01 -0700599 return NULL;
600 }
601
Simon Glass541f62c2020-12-22 19:30:30 -0700602 return dev->parent_plat_;
Simon Glass11b61732015-01-25 08:27:01 -0700603}
604
Simon Glass71fa5b42020-12-03 16:55:18 -0700605void *dev_get_uclass_plat(const struct udevice *dev)
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200606{
607 if (!dev) {
Simon Glasscdfc5052015-07-06 16:47:40 -0600608 dm_warn("%s: null device\n", __func__);
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200609 return NULL;
610 }
611
Simon Glass541f62c2020-12-22 19:30:30 -0700612 return dev->uclass_plat_;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200613}
614
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600615void *dev_get_priv(const struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700616{
617 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700618 dm_warn("%s: null device\n", __func__);
Simon Glassdd6ab882014-02-26 15:59:18 -0700619 return NULL;
620 }
621
Simon Glass541f62c2020-12-22 19:30:30 -0700622 return dev->priv_;
Simon Glassdd6ab882014-02-26 15:59:18 -0700623}
Simon Glass48d4e292014-07-23 06:55:19 -0600624
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600625void *dev_get_uclass_priv(const struct udevice *dev)
Simon Glassde0977b2015-03-05 12:25:20 -0700626{
627 if (!dev) {
628 dm_warn("%s: null device\n", __func__);
629 return NULL;
630 }
631
Simon Glass541f62c2020-12-22 19:30:30 -0700632 return dev->uclass_priv_;
Simon Glassde0977b2015-03-05 12:25:20 -0700633}
634
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600635void *dev_get_parent_priv(const struct udevice *dev)
Simon Glass60d971b2014-07-23 06:55:20 -0600636{
637 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700638 dm_warn("%s: null device\n", __func__);
Simon Glass60d971b2014-07-23 06:55:20 -0600639 return NULL;
640 }
641
Simon Glass541f62c2020-12-22 19:30:30 -0700642 return dev->parent_priv_;
Simon Glass60d971b2014-07-23 06:55:20 -0600643}
644
Simon Glass48d4e292014-07-23 06:55:19 -0600645static int device_get_device_tail(struct udevice *dev, int ret,
646 struct udevice **devp)
647{
648 if (ret)
649 return ret;
650
651 ret = device_probe(dev);
652 if (ret)
653 return ret;
654
655 *devp = dev;
656
657 return 0;
658}
659
Marek Vasut7f18c342019-08-31 18:03:28 +0200660#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
Mario Six3bedfbe2018-06-26 08:46:50 +0200661/**
662 * device_find_by_ofnode() - Return device associated with given ofnode
663 *
664 * The returned device is *not* activated.
665 *
666 * @node: The ofnode for which a associated device should be looked up
667 * @devp: Pointer to structure to hold the found device
668 * Return: 0 if OK, -ve on error
669 */
670static int device_find_by_ofnode(ofnode node, struct udevice **devp)
671{
672 struct uclass *uc;
673 struct udevice *dev;
674 int ret;
675
Simon Glass784cd9e2020-12-19 10:40:17 -0700676 list_for_each_entry(uc, gd->uclass_root, sibling_node) {
Mario Six3bedfbe2018-06-26 08:46:50 +0200677 ret = uclass_find_device_by_ofnode(uc->uc_drv->id, node,
678 &dev);
679 if (!ret || dev) {
680 *devp = dev;
681 return 0;
682 }
683 }
684
685 return -ENODEV;
686}
Marek Vasut7f18c342019-08-31 18:03:28 +0200687#endif
Mario Six3bedfbe2018-06-26 08:46:50 +0200688
Simon Glass2a580882020-01-27 08:49:36 -0700689int device_get_child(const struct udevice *parent, int index,
690 struct udevice **devp)
Simon Glass48d4e292014-07-23 06:55:19 -0600691{
692 struct udevice *dev;
693
694 list_for_each_entry(dev, &parent->child_head, sibling_node) {
695 if (!index--)
696 return device_get_device_tail(dev, 0, devp);
697 }
698
699 return -ENODEV;
700}
701
Simon Glass2a580882020-01-27 08:49:36 -0700702int device_get_child_count(const struct udevice *parent)
Lokesh Vutlafa45a082019-09-04 16:01:26 +0530703{
704 struct udevice *dev;
705 int count = 0;
706
707 list_for_each_entry(dev, &parent->child_head, sibling_node)
708 count++;
709
710 return count;
711}
712
Simon Glass07e13382020-12-16 21:20:29 -0700713int device_find_child_by_seq(const struct udevice *parent, int seq,
714 struct udevice **devp)
Simon Glass48d4e292014-07-23 06:55:19 -0600715{
716 struct udevice *dev;
717
718 *devp = NULL;
Simon Glass48d4e292014-07-23 06:55:19 -0600719
720 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Simon Glass5e349922020-12-19 10:40:09 -0700721 if (dev->seq_ == seq) {
Simon Glass48d4e292014-07-23 06:55:19 -0600722 *devp = dev;
723 return 0;
724 }
725 }
726
727 return -ENODEV;
728}
729
Simon Glass2a580882020-01-27 08:49:36 -0700730int device_get_child_by_seq(const struct udevice *parent, int seq,
Simon Glass48d4e292014-07-23 06:55:19 -0600731 struct udevice **devp)
732{
733 struct udevice *dev;
734 int ret;
735
736 *devp = NULL;
Simon Glass07e13382020-12-16 21:20:29 -0700737 ret = device_find_child_by_seq(parent, seq, &dev);
738
Simon Glass48d4e292014-07-23 06:55:19 -0600739 return device_get_device_tail(dev, ret, devp);
740}
741
Simon Glass2a580882020-01-27 08:49:36 -0700742int device_find_child_by_of_offset(const struct udevice *parent, int of_offset,
Simon Glass48d4e292014-07-23 06:55:19 -0600743 struct udevice **devp)
744{
745 struct udevice *dev;
746
747 *devp = NULL;
748
749 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Simon Glassdd79d6e2017-01-17 16:52:55 -0700750 if (dev_of_offset(dev) == of_offset) {
Simon Glass48d4e292014-07-23 06:55:19 -0600751 *devp = dev;
752 return 0;
753 }
754 }
755
756 return -ENODEV;
757}
758
Simon Glass2a580882020-01-27 08:49:36 -0700759int device_get_child_by_of_offset(const struct udevice *parent, int node,
Simon Glass48d4e292014-07-23 06:55:19 -0600760 struct udevice **devp)
761{
762 struct udevice *dev;
763 int ret;
764
765 *devp = NULL;
Simon Glass861bc9f2015-06-23 15:38:38 -0600766 ret = device_find_child_by_of_offset(parent, node, &dev);
Simon Glass48d4e292014-07-23 06:55:19 -0600767 return device_get_device_tail(dev, ret, devp);
768}
Simon Glass44da7352014-10-13 23:41:49 -0600769
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200770static struct udevice *_device_find_global_by_ofnode(struct udevice *parent,
771 ofnode ofnode)
Simon Glassae2efac2015-06-23 15:38:37 -0600772{
773 struct udevice *dev, *found;
774
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200775 if (ofnode_equal(dev_ofnode(parent), ofnode))
Simon Glassae2efac2015-06-23 15:38:37 -0600776 return parent;
777
778 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200779 found = _device_find_global_by_ofnode(dev, ofnode);
Simon Glassae2efac2015-06-23 15:38:37 -0600780 if (found)
781 return found;
782 }
783
784 return NULL;
785}
786
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200787int device_find_global_by_ofnode(ofnode ofnode, struct udevice **devp)
788{
789 *devp = _device_find_global_by_ofnode(gd->dm_root, ofnode);
790
791 return *devp ? 0 : -ENOENT;
792}
793
794int device_get_global_by_ofnode(ofnode ofnode, struct udevice **devp)
Simon Glassae2efac2015-06-23 15:38:37 -0600795{
796 struct udevice *dev;
797
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200798 dev = _device_find_global_by_ofnode(gd->dm_root, ofnode);
Simon Glassae2efac2015-06-23 15:38:37 -0600799 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
800}
Walter Lozanoffc41b02020-06-25 01:10:11 -0300801
802#if CONFIG_IS_ENABLED(OF_PLATDATA)
803int device_get_by_driver_info(const struct driver_info *info,
804 struct udevice **devp)
805{
Simon Glasscfd6a002020-10-03 11:31:33 -0600806 struct driver_info *info_base =
807 ll_entry_start(struct driver_info, driver_info);
808 int idx = info - info_base;
809 struct driver_rt *drt = gd_dm_driver_rt() + idx;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300810 struct udevice *dev;
811
Simon Glasscfd6a002020-10-03 11:31:33 -0600812 dev = drt->dev;
Simon Glassd825ea72020-10-03 11:31:31 -0600813 *devp = NULL;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300814
815 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
816}
Simon Glass5792f4b2020-10-03 11:31:40 -0600817
818int device_get_by_driver_info_idx(uint idx, struct udevice **devp)
819{
820 struct driver_rt *drt = gd_dm_driver_rt() + idx;
821 struct udevice *dev;
822
823 dev = drt->dev;
824 *devp = NULL;
825
826 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
827}
Walter Lozanoffc41b02020-06-25 01:10:11 -0300828#endif
Simon Glassae2efac2015-06-23 15:38:37 -0600829
Simon Glass2a580882020-01-27 08:49:36 -0700830int device_find_first_child(const struct udevice *parent, struct udevice **devp)
Simon Glass44da7352014-10-13 23:41:49 -0600831{
832 if (list_empty(&parent->child_head)) {
833 *devp = NULL;
834 } else {
835 *devp = list_first_entry(&parent->child_head, struct udevice,
836 sibling_node);
837 }
838
839 return 0;
840}
841
842int device_find_next_child(struct udevice **devp)
843{
844 struct udevice *dev = *devp;
845 struct udevice *parent = dev->parent;
846
847 if (list_is_last(&dev->sibling_node, &parent->child_head)) {
848 *devp = NULL;
849 } else {
850 *devp = list_entry(dev->sibling_node.next, struct udevice,
851 sibling_node);
852 }
853
854 return 0;
855}
Simon Glass70c3a0e2014-11-11 10:46:18 -0700856
Simon Glass2a580882020-01-27 08:49:36 -0700857int device_find_first_inactive_child(const struct udevice *parent,
Simon Glassb775e872018-10-01 12:22:07 -0600858 enum uclass_id uclass_id,
859 struct udevice **devp)
860{
861 struct udevice *dev;
862
863 *devp = NULL;
864 list_for_each_entry(dev, &parent->child_head, sibling_node) {
865 if (!device_active(dev) &&
866 device_get_uclass_id(dev) == uclass_id) {
867 *devp = dev;
868 return 0;
869 }
870 }
871
872 return -ENODEV;
873}
874
Simon Glass2a580882020-01-27 08:49:36 -0700875int device_find_first_child_by_uclass(const struct udevice *parent,
Simon Glassa11341a2018-11-18 08:14:31 -0700876 enum uclass_id uclass_id,
877 struct udevice **devp)
878{
879 struct udevice *dev;
880
881 *devp = NULL;
882 list_for_each_entry(dev, &parent->child_head, sibling_node) {
883 if (device_get_uclass_id(dev) == uclass_id) {
884 *devp = dev;
885 return 0;
886 }
887 }
888
889 return -ENODEV;
890}
891
Simon Glass2a580882020-01-27 08:49:36 -0700892int device_find_child_by_name(const struct udevice *parent, const char *name,
Simon Glassa11341a2018-11-18 08:14:31 -0700893 struct udevice **devp)
894{
895 struct udevice *dev;
896
897 *devp = NULL;
898
899 list_for_each_entry(dev, &parent->child_head, sibling_node) {
900 if (!strcmp(dev->name, name)) {
901 *devp = dev;
902 return 0;
903 }
904 }
905
906 return -ENODEV;
907}
908
Simon Glass76db9b72020-01-27 08:49:48 -0700909int device_first_child_err(struct udevice *parent, struct udevice **devp)
910{
911 struct udevice *dev;
912
913 device_find_first_child(parent, &dev);
914 if (!dev)
915 return -ENODEV;
916
917 return device_get_device_tail(dev, 0, devp);
918}
919
920int device_next_child_err(struct udevice **devp)
921{
922 struct udevice *dev = *devp;
923
924 device_find_next_child(&dev);
925 if (!dev)
926 return -ENODEV;
927
928 return device_get_device_tail(dev, 0, devp);
929}
930
Simon Glass000676b2020-01-27 08:49:47 -0700931int device_first_child_ofdata_err(struct udevice *parent, struct udevice **devp)
932{
933 struct udevice *dev;
934 int ret;
935
936 device_find_first_child(parent, &dev);
937 if (!dev)
938 return -ENODEV;
939
Simon Glassaad29ae2020-12-03 16:55:21 -0700940 ret = device_of_to_plat(dev);
Simon Glass000676b2020-01-27 08:49:47 -0700941 if (ret)
942 return ret;
943
944 *devp = dev;
945
946 return 0;
947}
948
949int device_next_child_ofdata_err(struct udevice **devp)
950{
951 struct udevice *dev = *devp;
952 int ret;
953
954 device_find_next_child(&dev);
955 if (!dev)
956 return -ENODEV;
957
Simon Glassaad29ae2020-12-03 16:55:21 -0700958 ret = device_of_to_plat(dev);
Simon Glass000676b2020-01-27 08:49:47 -0700959 if (ret)
960 return ret;
961
962 *devp = dev;
963
964 return 0;
965}
966
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600967struct udevice *dev_get_parent(const struct udevice *child)
Simon Glass43f488a2014-11-11 10:46:19 -0700968{
969 return child->parent;
970}
971
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600972ulong dev_get_driver_data(const struct udevice *dev)
Simon Glass70c3a0e2014-11-11 10:46:18 -0700973{
Simon Glass46227bd2015-03-25 12:21:55 -0600974 return dev->driver_data;
Simon Glass70c3a0e2014-11-11 10:46:18 -0700975}
Simon Glass98fd5d12015-01-25 08:27:04 -0700976
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600977const void *dev_get_driver_ops(const struct udevice *dev)
Przemyslaw Marczakd3ef0d72015-04-15 13:07:24 +0200978{
979 if (!dev || !dev->driver->ops)
980 return NULL;
981
982 return dev->driver->ops;
983}
984
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600985enum uclass_id device_get_uclass_id(const struct udevice *dev)
Simon Glass98fd5d12015-01-25 08:27:04 -0700986{
987 return dev->uclass->uc_drv->id;
988}
Peng Fan99b72352015-02-10 14:46:32 +0800989
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600990const char *dev_get_uclass_name(const struct udevice *dev)
Przemyslaw Marczak5ed2e422015-04-15 13:07:25 +0200991{
992 if (!dev)
993 return NULL;
994
995 return dev->uclass->uc_drv->name;
996}
997
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600998bool device_has_children(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -0600999{
1000 return !list_empty(&dev->child_head);
1001}
1002
Simon Glass2a580882020-01-27 08:49:36 -07001003bool device_has_active_children(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -06001004{
1005 struct udevice *child;
1006
1007 for (device_find_first_child(dev, &child);
1008 child;
1009 device_find_next_child(&child)) {
1010 if (device_active(child))
1011 return true;
1012 }
1013
1014 return false;
1015}
1016
Simon Glass2a580882020-01-27 08:49:36 -07001017bool device_is_last_sibling(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -06001018{
1019 struct udevice *parent = dev->parent;
1020
1021 if (!parent)
1022 return false;
1023 return list_is_last(&dev->sibling_node, &parent->child_head);
1024}
Simon Glasse3b23e22015-07-30 13:40:39 -06001025
Simon Glass7760ba22016-05-01 13:52:23 -06001026void device_set_name_alloced(struct udevice *dev)
1027{
Simon Glass6211d762020-12-19 10:40:10 -07001028 dev_or_flags(dev, DM_FLAG_NAME_ALLOCED);
Simon Glass7760ba22016-05-01 13:52:23 -06001029}
1030
Simon Glasse3b23e22015-07-30 13:40:39 -06001031int device_set_name(struct udevice *dev, const char *name)
1032{
1033 name = strdup(name);
1034 if (!name)
1035 return -ENOMEM;
1036 dev->name = name;
Simon Glass7760ba22016-05-01 13:52:23 -06001037 device_set_name_alloced(dev);
Simon Glasse3b23e22015-07-30 13:40:39 -06001038
1039 return 0;
1040}
Mugunthan V N4666bd92016-04-28 15:36:02 +05301041
Simon Glassd4f0c942020-12-22 19:30:27 -07001042void dev_set_priv(struct udevice *dev, void *priv)
1043{
Simon Glass541f62c2020-12-22 19:30:30 -07001044 dev->priv_ = priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001045}
1046
1047void dev_set_parent_priv(struct udevice *dev, void *parent_priv)
1048{
Simon Glass541f62c2020-12-22 19:30:30 -07001049 dev->parent_priv_ = parent_priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001050}
1051
1052void dev_set_uclass_priv(struct udevice *dev, void *uclass_priv)
1053{
Simon Glass541f62c2020-12-22 19:30:30 -07001054 dev->uclass_priv_ = uclass_priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001055}
1056
1057void dev_set_plat(struct udevice *dev, void *plat)
1058{
Simon Glass541f62c2020-12-22 19:30:30 -07001059 dev->plat_ = plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001060}
1061
1062void dev_set_parent_plat(struct udevice *dev, void *parent_plat)
1063{
Simon Glass541f62c2020-12-22 19:30:30 -07001064 dev->parent_plat_ = parent_plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001065}
1066
1067void dev_set_uclass_plat(struct udevice *dev, void *uclass_plat)
1068{
Simon Glass541f62c2020-12-22 19:30:30 -07001069 dev->uclass_plat_ = uclass_plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001070}
1071
Marek Vasut7f18c342019-08-31 18:03:28 +02001072#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
Simon Glass2a580882020-01-27 08:49:36 -07001073bool device_is_compatible(const struct udevice *dev, const char *compat)
Mugunthan V N4666bd92016-04-28 15:36:02 +05301074{
Masahiro Yamada9349bcc2018-04-19 12:14:02 +09001075 return ofnode_device_is_compatible(dev_ofnode(dev), compat);
Mugunthan V N4666bd92016-04-28 15:36:02 +05301076}
1077
1078bool of_machine_is_compatible(const char *compat)
1079{
1080 const void *fdt = gd->fdt_blob;
1081
1082 return !fdt_node_check_compatible(fdt, 0, compat);
1083}
Mario Six3bedfbe2018-06-26 08:46:50 +02001084
1085int dev_disable_by_path(const char *path)
1086{
1087 struct uclass *uc;
1088 ofnode node = ofnode_path(path);
1089 struct udevice *dev;
1090 int ret = 1;
1091
1092 if (!of_live_active())
1093 return -ENOSYS;
1094
Simon Glass784cd9e2020-12-19 10:40:17 -07001095 list_for_each_entry(uc, gd->uclass_root, sibling_node) {
Mario Six3bedfbe2018-06-26 08:46:50 +02001096 ret = uclass_find_device_by_ofnode(uc->uc_drv->id, node, &dev);
1097 if (!ret)
1098 break;
1099 }
1100
1101 if (ret)
1102 return ret;
1103
1104 ret = device_remove(dev, DM_REMOVE_NORMAL);
1105 if (ret)
1106 return ret;
1107
1108 ret = device_unbind(dev);
1109 if (ret)
1110 return ret;
1111
1112 return ofnode_set_enabled(node, false);
1113}
1114
1115int dev_enable_by_path(const char *path)
1116{
1117 ofnode node = ofnode_path(path);
1118 ofnode pnode = ofnode_get_parent(node);
1119 struct udevice *parent;
1120 int ret = 1;
1121
1122 if (!of_live_active())
1123 return -ENOSYS;
1124
1125 ret = device_find_by_ofnode(pnode, &parent);
1126 if (ret)
1127 return ret;
1128
1129 ret = ofnode_set_enabled(node, true);
1130 if (ret)
1131 return ret;
1132
Bin Meng9a9b0742018-10-10 22:06:58 -07001133 return lists_bind_fdt(parent, node, NULL, false);
Mario Six3bedfbe2018-06-26 08:46:50 +02001134}
Marek Vasut7f18c342019-08-31 18:03:28 +02001135#endif