blob: 81f6880eac410e0833e5e733969537caf7076684 [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 Glasse07434b2021-02-03 21:29:43 -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 Glasse07434b2021-02-03 21:29:43 -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 Glasse07434b2021-02-03 21:29:43 -0700104 if (of_plat_size)
Simon Glass6211d762020-12-19 10:40:10 -0700105 dev_or_flags(dev, DM_FLAG_OF_PLATDATA);
Simon Glasse07434b2021-02-03 21:29:43 -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 Glasse07434b2021-02-03 21:29:43 -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 Glassd6206a52021-02-03 21:29:44 -0700140 if (!size)
Simon Glass71fa5b42020-12-03 16:55:18 -0700141 size = parent->uclass->uc_drv->per_child_plat_auto;
Simon Glass11b61732015-01-25 08:27:01 -0700142 if (size) {
Simon Glass6211d762020-12-19 10:40:10 -0700143 dev_or_flags(dev, DM_FLAG_ALLOC_PARENT_PDATA);
Simon Glass2543b162020-12-22 19:30:29 -0700144 ptr = calloc(1, size);
145 if (!ptr) {
Simon Glass11b61732015-01-25 08:27:01 -0700146 ret = -ENOMEM;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200147 goto fail_alloc3;
Simon Glass11b61732015-01-25 08:27:01 -0700148 }
Simon Glass2543b162020-12-22 19:30:29 -0700149 dev_set_parent_plat(dev, ptr);
Simon Glass11b61732015-01-25 08:27:01 -0700150 }
Heinrich Schuchardt5246b372020-02-15 21:38:48 +0100151 /* put dev into parent's successor list */
Simon Glassdd6ab882014-02-26 15:59:18 -0700152 list_add_tail(&dev->sibling_node, &parent->child_head);
Heinrich Schuchardt5246b372020-02-15 21:38:48 +0100153 }
Simon Glassdd6ab882014-02-26 15:59:18 -0700154
155 ret = uclass_bind_device(dev);
156 if (ret)
Simon Glass4ebe01b2015-01-25 08:26:59 -0700157 goto fail_uclass_bind;
Simon Glassdd6ab882014-02-26 15:59:18 -0700158
159 /* if we fail to bind we remove device from successors and free it */
160 if (drv->bind) {
161 ret = drv->bind(dev);
Simon Glass4ebe01b2015-01-25 08:26:59 -0700162 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700163 goto fail_bind;
Simon Glassdd6ab882014-02-26 15:59:18 -0700164 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700165 if (parent && parent->driver->child_post_bind) {
166 ret = parent->driver->child_post_bind(dev);
167 if (ret)
168 goto fail_child_post_bind;
169 }
Simon Glass286863d2016-01-05 09:30:59 -0700170 if (uc->uc_drv->post_bind) {
171 ret = uc->uc_drv->post_bind(dev);
172 if (ret)
173 goto fail_uclass_post_bind;
174 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700175
Simon Glassdd6ab882014-02-26 15:59:18 -0700176 if (parent)
Masahiro Yamadaf70f39f2017-09-29 12:31:20 +0900177 pr_debug("Bound device %s to %s\n", dev->name, parent->name);
Masahiro Yamadae1cc1f02015-08-27 12:44:28 +0900178 if (devp)
179 *devp = dev;
Simon Glassdd6ab882014-02-26 15:59:18 -0700180
Simon Glass6211d762020-12-19 10:40:10 -0700181 dev_or_flags(dev, DM_FLAG_BOUND);
Masahiro Yamadabdbb5dd2015-07-25 21:52:34 +0900182
Simon Glassdd6ab882014-02-26 15:59:18 -0700183 return 0;
184
Simon Glass286863d2016-01-05 09:30:59 -0700185fail_uclass_post_bind:
186 /* There is no child unbind() method, so no clean-up required */
Simon Glassa4a51a02015-01-25 08:27:03 -0700187fail_child_post_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900188 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700189 if (drv->unbind && drv->unbind(dev)) {
190 dm_warn("unbind() method failed on dev '%s' on error path\n",
191 dev->name);
192 }
Simon Glassa4a51a02015-01-25 08:27:03 -0700193 }
194
Simon Glassdd6ab882014-02-26 15:59:18 -0700195fail_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900196 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700197 if (uclass_unbind_device(dev)) {
198 dm_warn("Failed to unbind dev '%s' on error path\n",
199 dev->name);
200 }
Simon Glass4ebe01b2015-01-25 08:26:59 -0700201 }
202fail_uclass_bind:
Masahiro Yamada04aa00d2015-08-12 07:31:52 +0900203 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
Simon Glasse70a4f42015-02-27 22:06:33 -0700204 list_del(&dev->sibling_node);
Simon Glass6211d762020-12-19 10:40:10 -0700205 if (dev_get_flags(dev) & DM_FLAG_ALLOC_PARENT_PDATA) {
Simon Glass2543b162020-12-22 19:30:29 -0700206 free(dev_get_parent_plat(dev));
207 dev_set_parent_plat(dev, NULL);
Simon Glasse70a4f42015-02-27 22:06:33 -0700208 }
Simon Glass11b61732015-01-25 08:27:01 -0700209 }
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200210fail_alloc3:
Simon Glassd6206a52021-02-03 21:29:44 -0700211 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
212 if (dev_get_flags(dev) & DM_FLAG_ALLOC_UCLASS_PDATA) {
213 free(dev_get_uclass_plat(dev));
214 dev_set_uclass_plat(dev, NULL);
215 }
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200216 }
Simon Glass11b61732015-01-25 08:27:01 -0700217fail_alloc2:
Simon Glassd6206a52021-02-03 21:29:44 -0700218 if (CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)) {
219 if (dev_get_flags(dev) & DM_FLAG_ALLOC_PDATA) {
220 free(dev_get_plat(dev));
221 dev_set_plat(dev, NULL);
222 }
Simon Glassba750492015-01-25 08:27:00 -0700223 }
224fail_alloc1:
Masahiro Yamada8b15b162015-07-25 21:52:35 +0900225 devres_release_all(dev);
226
Simon Glassdd6ab882014-02-26 15:59:18 -0700227 free(dev);
Simon Glass4ebe01b2015-01-25 08:26:59 -0700228
Simon Glassdd6ab882014-02-26 15:59:18 -0700229 return ret;
230}
231
Stephen Warren8c93df12016-05-11 15:26:24 -0600232int device_bind_with_driver_data(struct udevice *parent,
233 const struct driver *drv, const char *name,
Simon Glass322b2902017-05-18 20:09:05 -0600234 ulong driver_data, ofnode node,
Stephen Warren8c93df12016-05-11 15:26:24 -0600235 struct udevice **devp)
236{
Simon Glass322b2902017-05-18 20:09:05 -0600237 return device_bind_common(parent, drv, name, NULL, driver_data, node,
238 0, devp);
Stephen Warren8c93df12016-05-11 15:26:24 -0600239}
240
Simon Glass884870f2020-11-28 17:50:01 -0700241int device_bind(struct udevice *parent, const struct driver *drv,
Simon Glass71fa5b42020-12-03 16:55:18 -0700242 const char *name, void *plat, ofnode node,
Simon Glass884870f2020-11-28 17:50:01 -0700243 struct udevice **devp)
Simon Glass9eb151e2018-06-11 13:07:15 -0600244{
Simon Glass71fa5b42020-12-03 16:55:18 -0700245 return device_bind_common(parent, drv, name, plat, 0, node, 0,
Simon Glass9eb151e2018-06-11 13:07:15 -0600246 devp);
247}
248
Simon Glassfef72b72014-07-23 06:55:03 -0600249int device_bind_by_name(struct udevice *parent, bool pre_reloc_only,
Simon Glasscfd6a002020-10-03 11:31:33 -0600250 const struct driver_info *info, struct udevice **devp)
Simon Glassdd6ab882014-02-26 15:59:18 -0700251{
252 struct driver *drv;
Simon Glass39edb952020-12-03 16:55:19 -0700253 uint plat_size = 0;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300254 int ret;
Simon Glassdd6ab882014-02-26 15:59:18 -0700255
256 drv = lists_driver_lookup_name(info->name);
257 if (!drv)
258 return -ENOENT;
Simon Glassfef72b72014-07-23 06:55:03 -0600259 if (pre_reloc_only && !(drv->flags & DM_FLAG_PRE_RELOC))
260 return -EPERM;
Simon Glassdd6ab882014-02-26 15:59:18 -0700261
Simon Glassafbf9b82016-07-04 11:58:18 -0600262#if CONFIG_IS_ENABLED(OF_PLATDATA)
Simon Glass39edb952020-12-03 16:55:19 -0700263 plat_size = info->plat_size;
Simon Glassafbf9b82016-07-04 11:58:18 -0600264#endif
Simon Glass71fa5b42020-12-03 16:55:18 -0700265 ret = device_bind_common(parent, drv, info->name, (void *)info->plat, 0,
Simon Glass39edb952020-12-03 16:55:19 -0700266 ofnode_null(), plat_size, devp);
Walter Lozanoffc41b02020-06-25 01:10:11 -0300267 if (ret)
268 return ret;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300269
270 return ret;
Simon Glassdd6ab882014-02-26 15:59:18 -0700271}
272
Claudiu Bezneabf5b8232020-09-07 17:46:33 +0300273int device_reparent(struct udevice *dev, struct udevice *new_parent)
274{
275 struct udevice *pos, *n;
276
277 assert(dev);
278 assert(new_parent);
279
280 list_for_each_entry_safe(pos, n, &dev->parent->child_head,
281 sibling_node) {
282 if (pos->driver != dev->driver)
283 continue;
284
285 list_del(&dev->sibling_node);
286 list_add_tail(&dev->sibling_node, &new_parent->child_head);
287 dev->parent = new_parent;
288
289 break;
290 }
291
292 return 0;
293}
294
Simon Glass825d3f92015-03-25 12:21:53 -0600295static void *alloc_priv(int size, uint flags)
296{
297 void *priv;
298
299 if (flags & DM_FLAG_ALLOC_PRIV_DMA) {
Faiz Abbas03020a92017-09-19 16:53:50 +0530300 size = ROUND(size, ARCH_DMA_MINALIGN);
Simon Glass825d3f92015-03-25 12:21:53 -0600301 priv = memalign(ARCH_DMA_MINALIGN, size);
Simon Glass27bc9b12017-04-04 13:00:19 -0600302 if (priv) {
Simon Glass825d3f92015-03-25 12:21:53 -0600303 memset(priv, '\0', size);
Simon Glass27bc9b12017-04-04 13:00:19 -0600304
305 /*
306 * Ensure that the zero bytes are flushed to memory.
307 * This prevents problems if the driver uses this as
308 * both an input and an output buffer:
309 *
310 * 1. Zeroes written to buffer (here) and sit in the
311 * cache
312 * 2. Driver issues a read command to DMA
313 * 3. CPU runs out of cache space and evicts some cache
314 * data in the buffer, writing zeroes to RAM from
315 * the memset() above
316 * 4. DMA completes
317 * 5. Buffer now has some DMA data and some zeroes
318 * 6. Data being read is now incorrect
319 *
320 * To prevent this, ensure that the cache is clean
321 * within this range at the start. The driver can then
322 * use normal flush-after-write, invalidate-before-read
323 * procedures.
324 *
325 * TODO(sjg@chromium.org): Drop this microblaze
326 * exception.
327 */
328#ifndef CONFIG_MICROBLAZE
329 flush_dcache_range((ulong)priv, (ulong)priv + size);
330#endif
331 }
Simon Glass825d3f92015-03-25 12:21:53 -0600332 } else {
333 priv = calloc(1, size);
334 }
335
336 return priv;
337}
338
Simon Glassad337e62020-12-19 10:40:08 -0700339/**
340 * device_alloc_priv() - Allocate priv/plat data required by the device
341 *
342 * @dev: Device to process
343 * @return 0 if OK, -ENOMEM if out of memory
344 */
345static int device_alloc_priv(struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700346{
Simon Glassa626dff2015-03-25 12:21:54 -0600347 const struct driver *drv;
Simon Glass2543b162020-12-22 19:30:29 -0700348 void *ptr;
Simon Glassad337e62020-12-19 10:40:08 -0700349 int size;
Simon Glass44c47892020-04-05 15:38:19 -0600350
Simon Glassdd6ab882014-02-26 15:59:18 -0700351 drv = dev->driver;
352 assert(drv);
353
Bin Meng82cdd782015-08-24 01:14:02 -0700354 /* Allocate private data if requested and not reentered */
Simon Glass2543b162020-12-22 19:30:29 -0700355 if (drv->priv_auto && !dev_get_priv(dev)) {
356 ptr = alloc_priv(drv->priv_auto, drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700357 if (!ptr)
358 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700359 dev_set_priv(dev, ptr);
Simon Glassdd6ab882014-02-26 15:59:18 -0700360 }
Simon Glassad337e62020-12-19 10:40:08 -0700361
Bin Meng82cdd782015-08-24 01:14:02 -0700362 /* Allocate private data if requested and not reentered */
Simon Glass8a2b47f2020-12-03 16:55:17 -0700363 size = dev->uclass->uc_drv->per_device_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700364 if (size && !dev_get_uclass_priv(dev)) {
365 ptr = alloc_priv(size, dev->uclass->uc_drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700366 if (!ptr)
367 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700368 dev_set_uclass_priv(dev, ptr);
Simon Glassdd6ab882014-02-26 15:59:18 -0700369 }
370
Simon Glassa8d8f162019-12-29 21:19:18 -0700371 /* Allocate parent data for this child */
Simon Glassdd6ab882014-02-26 15:59:18 -0700372 if (dev->parent) {
Simon Glass8a2b47f2020-12-03 16:55:17 -0700373 size = dev->parent->driver->per_child_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700374 if (!size)
Simon Glass8a2b47f2020-12-03 16:55:17 -0700375 size = dev->parent->uclass->uc_drv->per_child_auto;
Simon Glass2543b162020-12-22 19:30:29 -0700376 if (size && !dev_get_parent_priv(dev)) {
377 ptr = alloc_priv(size, drv->flags);
Simon Glassad337e62020-12-19 10:40:08 -0700378 if (!ptr)
379 return -ENOMEM;
Simon Glass2543b162020-12-22 19:30:29 -0700380 dev_set_parent_priv(dev, ptr);
Simon Glass60d971b2014-07-23 06:55:20 -0600381 }
Simon Glassa8d8f162019-12-29 21:19:18 -0700382 }
383
Simon Glassad337e62020-12-19 10:40:08 -0700384 return 0;
385}
386
387int device_of_to_plat(struct udevice *dev)
388{
389 const struct driver *drv;
390 int ret;
391
392 if (!dev)
393 return -EINVAL;
394
Simon Glass6211d762020-12-19 10:40:10 -0700395 if (dev_get_flags(dev) & DM_FLAG_PLATDATA_VALID)
Simon Glassad337e62020-12-19 10:40:08 -0700396 return 0;
397
398 /* Ensure all parents have ofdata */
399 if (dev->parent) {
400 ret = device_of_to_plat(dev->parent);
401 if (ret)
402 goto fail;
403
404 /*
405 * The device might have already been probed during
406 * the call to device_probe() on its parent device
407 * (e.g. PCI bridge devices). Test the flags again
408 * so that we don't mess up the device.
409 */
Simon Glass6211d762020-12-19 10:40:10 -0700410 if (dev_get_flags(dev) & DM_FLAG_PLATDATA_VALID)
Simon Glassad337e62020-12-19 10:40:08 -0700411 return 0;
412 }
413
414 ret = device_alloc_priv(dev);
415 if (ret)
416 goto fail;
417
418 drv = dev->driver;
419 assert(drv);
420
Simon Glassaad29ae2020-12-03 16:55:21 -0700421 if (drv->of_to_plat &&
Simon Glass07c17772020-12-19 10:40:12 -0700422 (CONFIG_IS_ENABLED(OF_PLATDATA) || dev_has_ofnode(dev))) {
Simon Glassaad29ae2020-12-03 16:55:21 -0700423 ret = drv->of_to_plat(dev);
Simon Glassa8d8f162019-12-29 21:19:18 -0700424 if (ret)
425 goto fail;
426 }
Simon Glass60d971b2014-07-23 06:55:20 -0600427
Simon Glass6211d762020-12-19 10:40:10 -0700428 dev_or_flags(dev, DM_FLAG_PLATDATA_VALID);
Simon Glassd3c9d302019-12-29 21:19:21 -0700429
Simon Glass4a263852019-12-29 21:19:20 -0700430 return 0;
431fail:
432 device_free(dev);
433
434 return ret;
435}
436
Nicolas Saenz Juliennea2c7ead2021-01-12 13:55:24 +0100437/**
438 * device_get_dma_constraints() - Populate device's DMA constraints
439 *
440 * Gets a device's DMA constraints from firmware. This information is later
441 * used by drivers to translate physcal addresses to the device's bus address
442 * space. For now only device-tree is supported.
443 *
444 * @dev: Pointer to target device
445 * Return: 0 if OK or if no DMA constraints were found, error otherwise
446 */
447static int device_get_dma_constraints(struct udevice *dev)
448{
449 struct udevice *parent = dev->parent;
450 phys_addr_t cpu = 0;
451 dma_addr_t bus = 0;
452 u64 size = 0;
453 int ret;
454
455 if (!CONFIG_IS_ENABLED(DM_DMA) || !parent || !dev_has_ofnode(parent))
456 return 0;
457
458 /*
459 * We start parsing for dma-ranges from the device's bus node. This is
460 * specially important on nested buses.
461 */
462 ret = dev_get_dma_range(parent, &cpu, &bus, &size);
463 /* Don't return an error if no 'dma-ranges' were found */
464 if (ret && ret != -ENOENT) {
465 dm_warn("%s: failed to get DMA range, %d\n", dev->name, ret);
466 return ret;
467 }
468
469 dev_set_dma_offset(dev, cpu - bus);
470
471 return 0;
472}
473
Simon Glass4a263852019-12-29 21:19:20 -0700474int device_probe(struct udevice *dev)
475{
476 const struct driver *drv;
477 int ret;
Simon Glass4a263852019-12-29 21:19:20 -0700478
479 if (!dev)
480 return -EINVAL;
481
Simon Glass6211d762020-12-19 10:40:10 -0700482 if (dev_get_flags(dev) & DM_FLAG_ACTIVATED)
Simon Glass4a263852019-12-29 21:19:20 -0700483 return 0;
484
485 drv = dev->driver;
486 assert(drv);
487
Simon Glassaad29ae2020-12-03 16:55:21 -0700488 ret = device_of_to_plat(dev);
Simon Glass4a263852019-12-29 21:19:20 -0700489 if (ret)
490 goto fail;
491
Simon Glassa8d8f162019-12-29 21:19:18 -0700492 /* Ensure all parents are probed */
493 if (dev->parent) {
Simon Glassdd6ab882014-02-26 15:59:18 -0700494 ret = device_probe(dev->parent);
495 if (ret)
496 goto fail;
Bin Meng82cdd782015-08-24 01:14:02 -0700497
498 /*
499 * The device might have already been probed during
500 * the call to device_probe() on its parent device
501 * (e.g. PCI bridge devices). Test the flags again
502 * so that we don't mess up the device.
503 */
Simon Glass6211d762020-12-19 10:40:10 -0700504 if (dev_get_flags(dev) & DM_FLAG_ACTIVATED)
Bin Meng82cdd782015-08-24 01:14:02 -0700505 return 0;
Simon Glassdd6ab882014-02-26 15:59:18 -0700506 }
Simon Glassdb6f0202014-07-23 06:55:12 -0600507
Simon Glass6211d762020-12-19 10:40:10 -0700508 dev_or_flags(dev, DM_FLAG_ACTIVATED);
Simon Glass8b04e732015-03-25 12:21:56 -0600509
Simon Glassbb53bda2015-09-12 08:45:19 -0600510 /*
511 * Process pinctrl for everything except the root device, and
Simon Glass27ce9622016-01-21 19:43:25 -0700512 * continue regardless of the result of pinctrl. Don't process pinctrl
513 * settings for pinctrl devices since the device may not yet be
514 * probed.
Simon Glass303c3c22021-01-21 13:57:13 -0700515 *
516 * This call can produce some non-intuitive results. For example, on an
517 * x86 device where dev is the main PCI bus, the pinctrl device may be
518 * child or grandchild of that bus, meaning that the child will be
519 * probed here. If the child happens to be the P2SB and the pinctrl
520 * device is a child of that, then both the pinctrl and P2SB will be
521 * probed by this call. This works because the DM_FLAG_ACTIVATED flag
522 * is set just above. However, the PCI bus' probe() method and
523 * associated uclass methods have not yet been called.
Simon Glassbb53bda2015-09-12 08:45:19 -0600524 */
Simon Glass27ce9622016-01-21 19:43:25 -0700525 if (dev->parent && device_get_uclass_id(dev) != UCLASS_PINCTRL)
Simon Glassbb53bda2015-09-12 08:45:19 -0600526 pinctrl_select_state(dev, "default");
Masahiro Yamadaf8efa632015-08-27 12:44:29 +0900527
Anatolij Gustschin63a34672019-07-14 21:11:01 +0200528 if (CONFIG_IS_ENABLED(POWER_DOMAIN) && dev->parent &&
Lokesh Vutlac10e52b2019-09-27 13:48:12 +0530529 (device_get_uclass_id(dev) != UCLASS_POWER_DOMAIN) &&
530 !(drv->flags & DM_FLAG_DEFAULT_PD_CTRL_OFF)) {
Peng Fand2201112019-09-17 09:29:22 +0000531 ret = dev_power_domain_on(dev);
532 if (ret)
533 goto fail;
Peng Fan6fba32d2018-07-27 10:20:38 +0800534 }
535
Nicolas Saenz Juliennea2c7ead2021-01-12 13:55:24 +0100536 ret = device_get_dma_constraints(dev);
537 if (ret)
538 goto fail;
539
Simon Glass9c1f3822015-03-05 12:25:22 -0700540 ret = uclass_pre_probe_device(dev);
Simon Glass5104b982015-01-25 08:27:10 -0700541 if (ret)
542 goto fail;
543
Simon Glassd45560d2014-07-23 06:55:21 -0600544 if (dev->parent && dev->parent->driver->child_pre_probe) {
545 ret = dev->parent->driver->child_pre_probe(dev);
546 if (ret)
547 goto fail;
548 }
549
Bin Meng513cf402019-07-05 09:23:16 -0700550 /* Only handle devices that have a valid ofnode */
Simon Glassf1d50f72020-12-19 10:40:13 -0700551 if (dev_has_ofnode(dev)) {
Bin Meng513cf402019-07-05 09:23:16 -0700552 /*
553 * Process 'assigned-{clocks/clock-parents/clock-rates}'
554 * properties
555 */
Jean-Jacques Hiblot9601f322019-10-22 14:00:06 +0200556 ret = clk_set_defaults(dev, 0);
Bin Meng513cf402019-07-05 09:23:16 -0700557 if (ret)
558 goto fail;
559 }
Philipp Tomsich9cf03b02018-01-08 13:59:18 +0100560
Simon Glassdd6ab882014-02-26 15:59:18 -0700561 if (drv->probe) {
562 ret = drv->probe(dev);
Simon Glass9046dec2019-12-29 21:19:16 -0700563 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700564 goto fail;
565 }
566
Simon Glassdd6ab882014-02-26 15:59:18 -0700567 ret = uclass_post_probe_device(dev);
Simon Glass8b04e732015-03-25 12:21:56 -0600568 if (ret)
Simon Glassdd6ab882014-02-26 15:59:18 -0700569 goto fail_uclass;
Simon Glassdd6ab882014-02-26 15:59:18 -0700570
Peng Fan7cf58dd2016-03-12 13:17:38 +0800571 if (dev->parent && device_get_uclass_id(dev) == UCLASS_PINCTRL)
572 pinctrl_select_state(dev, "default");
573
Simon Glassdd6ab882014-02-26 15:59:18 -0700574 return 0;
575fail_uclass:
Stefan Roese80b5bc92017-03-20 12:51:48 +0100576 if (device_remove(dev, DM_REMOVE_NORMAL)) {
Simon Glassdd6ab882014-02-26 15:59:18 -0700577 dm_warn("%s: Device '%s' failed to remove on error path\n",
578 __func__, dev->name);
579 }
580fail:
Simon Glass6211d762020-12-19 10:40:10 -0700581 dev_bic_flags(dev, DM_FLAG_ACTIVATED);
Simon Glass8b04e732015-03-25 12:21:56 -0600582
Simon Glassdd6ab882014-02-26 15:59:18 -0700583 device_free(dev);
584
585 return ret;
586}
587
Simon Glassfa20e932020-12-03 16:55:20 -0700588void *dev_get_plat(const struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700589{
590 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700591 dm_warn("%s: null device\n", __func__);
Simon Glassdd6ab882014-02-26 15:59:18 -0700592 return NULL;
593 }
594
Simon Glass541f62c2020-12-22 19:30:30 -0700595 return dev->plat_;
Simon Glassdd6ab882014-02-26 15:59:18 -0700596}
597
Simon Glass71fa5b42020-12-03 16:55:18 -0700598void *dev_get_parent_plat(const struct udevice *dev)
Simon Glass11b61732015-01-25 08:27:01 -0700599{
600 if (!dev) {
Simon Glasscdfc5052015-07-06 16:47:40 -0600601 dm_warn("%s: null device\n", __func__);
Simon Glass11b61732015-01-25 08:27:01 -0700602 return NULL;
603 }
604
Simon Glass541f62c2020-12-22 19:30:30 -0700605 return dev->parent_plat_;
Simon Glass11b61732015-01-25 08:27:01 -0700606}
607
Simon Glass71fa5b42020-12-03 16:55:18 -0700608void *dev_get_uclass_plat(const struct udevice *dev)
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200609{
610 if (!dev) {
Simon Glasscdfc5052015-07-06 16:47:40 -0600611 dm_warn("%s: null device\n", __func__);
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200612 return NULL;
613 }
614
Simon Glass541f62c2020-12-22 19:30:30 -0700615 return dev->uclass_plat_;
Przemyslaw Marczakd850e672015-04-15 13:07:18 +0200616}
617
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600618void *dev_get_priv(const struct udevice *dev)
Simon Glassdd6ab882014-02-26 15:59:18 -0700619{
620 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700621 dm_warn("%s: null device\n", __func__);
Simon Glassdd6ab882014-02-26 15:59:18 -0700622 return NULL;
623 }
624
Simon Glass541f62c2020-12-22 19:30:30 -0700625 return dev->priv_;
Simon Glassdd6ab882014-02-26 15:59:18 -0700626}
Simon Glass48d4e292014-07-23 06:55:19 -0600627
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600628void *dev_get_uclass_priv(const struct udevice *dev)
Simon Glassde0977b2015-03-05 12:25:20 -0700629{
630 if (!dev) {
631 dm_warn("%s: null device\n", __func__);
632 return NULL;
633 }
634
Simon Glass541f62c2020-12-22 19:30:30 -0700635 return dev->uclass_priv_;
Simon Glassde0977b2015-03-05 12:25:20 -0700636}
637
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600638void *dev_get_parent_priv(const struct udevice *dev)
Simon Glass60d971b2014-07-23 06:55:20 -0600639{
640 if (!dev) {
Simon Glassdf1e0722014-12-10 08:55:56 -0700641 dm_warn("%s: null device\n", __func__);
Simon Glass60d971b2014-07-23 06:55:20 -0600642 return NULL;
643 }
644
Simon Glass541f62c2020-12-22 19:30:30 -0700645 return dev->parent_priv_;
Simon Glass60d971b2014-07-23 06:55:20 -0600646}
647
Simon Glass48d4e292014-07-23 06:55:19 -0600648static int device_get_device_tail(struct udevice *dev, int ret,
649 struct udevice **devp)
650{
651 if (ret)
652 return ret;
653
654 ret = device_probe(dev);
655 if (ret)
656 return ret;
657
658 *devp = dev;
659
660 return 0;
661}
662
Marek Vasut7f18c342019-08-31 18:03:28 +0200663#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
Mario Six3bedfbe2018-06-26 08:46:50 +0200664/**
665 * device_find_by_ofnode() - Return device associated with given ofnode
666 *
667 * The returned device is *not* activated.
668 *
669 * @node: The ofnode for which a associated device should be looked up
670 * @devp: Pointer to structure to hold the found device
671 * Return: 0 if OK, -ve on error
672 */
673static int device_find_by_ofnode(ofnode node, struct udevice **devp)
674{
675 struct uclass *uc;
676 struct udevice *dev;
677 int ret;
678
Simon Glass784cd9e2020-12-19 10:40:17 -0700679 list_for_each_entry(uc, gd->uclass_root, sibling_node) {
Mario Six3bedfbe2018-06-26 08:46:50 +0200680 ret = uclass_find_device_by_ofnode(uc->uc_drv->id, node,
681 &dev);
682 if (!ret || dev) {
683 *devp = dev;
684 return 0;
685 }
686 }
687
688 return -ENODEV;
689}
Marek Vasut7f18c342019-08-31 18:03:28 +0200690#endif
Mario Six3bedfbe2018-06-26 08:46:50 +0200691
Simon Glass2a580882020-01-27 08:49:36 -0700692int device_get_child(const struct udevice *parent, int index,
693 struct udevice **devp)
Simon Glass48d4e292014-07-23 06:55:19 -0600694{
695 struct udevice *dev;
696
697 list_for_each_entry(dev, &parent->child_head, sibling_node) {
698 if (!index--)
699 return device_get_device_tail(dev, 0, devp);
700 }
701
702 return -ENODEV;
703}
704
Simon Glass2a580882020-01-27 08:49:36 -0700705int device_get_child_count(const struct udevice *parent)
Lokesh Vutlafa45a082019-09-04 16:01:26 +0530706{
707 struct udevice *dev;
708 int count = 0;
709
710 list_for_each_entry(dev, &parent->child_head, sibling_node)
711 count++;
712
713 return count;
714}
715
Simon Glass07e13382020-12-16 21:20:29 -0700716int device_find_child_by_seq(const struct udevice *parent, int seq,
717 struct udevice **devp)
Simon Glass48d4e292014-07-23 06:55:19 -0600718{
719 struct udevice *dev;
720
721 *devp = NULL;
Simon Glass48d4e292014-07-23 06:55:19 -0600722
723 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Simon Glass5e349922020-12-19 10:40:09 -0700724 if (dev->seq_ == seq) {
Simon Glass48d4e292014-07-23 06:55:19 -0600725 *devp = dev;
726 return 0;
727 }
728 }
729
730 return -ENODEV;
731}
732
Simon Glass2a580882020-01-27 08:49:36 -0700733int device_get_child_by_seq(const struct udevice *parent, int seq,
Simon Glass48d4e292014-07-23 06:55:19 -0600734 struct udevice **devp)
735{
736 struct udevice *dev;
737 int ret;
738
739 *devp = NULL;
Simon Glass07e13382020-12-16 21:20:29 -0700740 ret = device_find_child_by_seq(parent, seq, &dev);
741
Simon Glass48d4e292014-07-23 06:55:19 -0600742 return device_get_device_tail(dev, ret, devp);
743}
744
Simon Glass2a580882020-01-27 08:49:36 -0700745int device_find_child_by_of_offset(const struct udevice *parent, int of_offset,
Simon Glass48d4e292014-07-23 06:55:19 -0600746 struct udevice **devp)
747{
748 struct udevice *dev;
749
750 *devp = NULL;
751
752 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Simon Glassdd79d6e2017-01-17 16:52:55 -0700753 if (dev_of_offset(dev) == of_offset) {
Simon Glass48d4e292014-07-23 06:55:19 -0600754 *devp = dev;
755 return 0;
756 }
757 }
758
759 return -ENODEV;
760}
761
Simon Glass2a580882020-01-27 08:49:36 -0700762int device_get_child_by_of_offset(const struct udevice *parent, int node,
Simon Glass48d4e292014-07-23 06:55:19 -0600763 struct udevice **devp)
764{
765 struct udevice *dev;
766 int ret;
767
768 *devp = NULL;
Simon Glass861bc9f2015-06-23 15:38:38 -0600769 ret = device_find_child_by_of_offset(parent, node, &dev);
Simon Glass48d4e292014-07-23 06:55:19 -0600770 return device_get_device_tail(dev, ret, devp);
771}
Simon Glass44da7352014-10-13 23:41:49 -0600772
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200773static struct udevice *_device_find_global_by_ofnode(struct udevice *parent,
774 ofnode ofnode)
Simon Glassae2efac2015-06-23 15:38:37 -0600775{
776 struct udevice *dev, *found;
777
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200778 if (ofnode_equal(dev_ofnode(parent), ofnode))
Simon Glassae2efac2015-06-23 15:38:37 -0600779 return parent;
780
781 list_for_each_entry(dev, &parent->child_head, sibling_node) {
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200782 found = _device_find_global_by_ofnode(dev, ofnode);
Simon Glassae2efac2015-06-23 15:38:37 -0600783 if (found)
784 return found;
785 }
786
787 return NULL;
788}
789
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200790int device_find_global_by_ofnode(ofnode ofnode, struct udevice **devp)
791{
792 *devp = _device_find_global_by_ofnode(gd->dm_root, ofnode);
793
794 return *devp ? 0 : -ENOENT;
795}
796
797int device_get_global_by_ofnode(ofnode ofnode, struct udevice **devp)
Simon Glassae2efac2015-06-23 15:38:37 -0600798{
799 struct udevice *dev;
800
Jean-Jacques Hiblota7b0d6a2018-08-09 16:17:44 +0200801 dev = _device_find_global_by_ofnode(gd->dm_root, ofnode);
Simon Glassae2efac2015-06-23 15:38:37 -0600802 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
803}
Walter Lozanoffc41b02020-06-25 01:10:11 -0300804
805#if CONFIG_IS_ENABLED(OF_PLATDATA)
806int device_get_by_driver_info(const struct driver_info *info,
807 struct udevice **devp)
808{
Simon Glasscfd6a002020-10-03 11:31:33 -0600809 struct driver_info *info_base =
810 ll_entry_start(struct driver_info, driver_info);
811 int idx = info - info_base;
812 struct driver_rt *drt = gd_dm_driver_rt() + idx;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300813 struct udevice *dev;
814
Simon Glasscfd6a002020-10-03 11:31:33 -0600815 dev = drt->dev;
Simon Glassd825ea72020-10-03 11:31:31 -0600816 *devp = NULL;
Walter Lozanoffc41b02020-06-25 01:10:11 -0300817
818 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
819}
Simon Glass5792f4b2020-10-03 11:31:40 -0600820
821int device_get_by_driver_info_idx(uint idx, struct udevice **devp)
822{
823 struct driver_rt *drt = gd_dm_driver_rt() + idx;
824 struct udevice *dev;
825
826 dev = drt->dev;
827 *devp = NULL;
828
829 return device_get_device_tail(dev, dev ? 0 : -ENOENT, devp);
830}
Walter Lozanoffc41b02020-06-25 01:10:11 -0300831#endif
Simon Glassae2efac2015-06-23 15:38:37 -0600832
Simon Glass2a580882020-01-27 08:49:36 -0700833int device_find_first_child(const struct udevice *parent, struct udevice **devp)
Simon Glass44da7352014-10-13 23:41:49 -0600834{
835 if (list_empty(&parent->child_head)) {
836 *devp = NULL;
837 } else {
838 *devp = list_first_entry(&parent->child_head, struct udevice,
839 sibling_node);
840 }
841
842 return 0;
843}
844
845int device_find_next_child(struct udevice **devp)
846{
847 struct udevice *dev = *devp;
848 struct udevice *parent = dev->parent;
849
850 if (list_is_last(&dev->sibling_node, &parent->child_head)) {
851 *devp = NULL;
852 } else {
853 *devp = list_entry(dev->sibling_node.next, struct udevice,
854 sibling_node);
855 }
856
857 return 0;
858}
Simon Glass70c3a0e2014-11-11 10:46:18 -0700859
Simon Glass2a580882020-01-27 08:49:36 -0700860int device_find_first_inactive_child(const struct udevice *parent,
Simon Glassb775e872018-10-01 12:22:07 -0600861 enum uclass_id uclass_id,
862 struct udevice **devp)
863{
864 struct udevice *dev;
865
866 *devp = NULL;
867 list_for_each_entry(dev, &parent->child_head, sibling_node) {
868 if (!device_active(dev) &&
869 device_get_uclass_id(dev) == uclass_id) {
870 *devp = dev;
871 return 0;
872 }
873 }
874
875 return -ENODEV;
876}
877
Simon Glass2a580882020-01-27 08:49:36 -0700878int device_find_first_child_by_uclass(const struct udevice *parent,
Simon Glassa11341a2018-11-18 08:14:31 -0700879 enum uclass_id uclass_id,
880 struct udevice **devp)
881{
882 struct udevice *dev;
883
884 *devp = NULL;
885 list_for_each_entry(dev, &parent->child_head, sibling_node) {
886 if (device_get_uclass_id(dev) == uclass_id) {
887 *devp = dev;
888 return 0;
889 }
890 }
891
892 return -ENODEV;
893}
894
Simon Glass2a580882020-01-27 08:49:36 -0700895int device_find_child_by_name(const struct udevice *parent, const char *name,
Simon Glassa11341a2018-11-18 08:14:31 -0700896 struct udevice **devp)
897{
898 struct udevice *dev;
899
900 *devp = NULL;
901
902 list_for_each_entry(dev, &parent->child_head, sibling_node) {
903 if (!strcmp(dev->name, name)) {
904 *devp = dev;
905 return 0;
906 }
907 }
908
909 return -ENODEV;
910}
911
Simon Glass76db9b72020-01-27 08:49:48 -0700912int device_first_child_err(struct udevice *parent, struct udevice **devp)
913{
914 struct udevice *dev;
915
916 device_find_first_child(parent, &dev);
917 if (!dev)
918 return -ENODEV;
919
920 return device_get_device_tail(dev, 0, devp);
921}
922
923int device_next_child_err(struct udevice **devp)
924{
925 struct udevice *dev = *devp;
926
927 device_find_next_child(&dev);
928 if (!dev)
929 return -ENODEV;
930
931 return device_get_device_tail(dev, 0, devp);
932}
933
Simon Glass000676b2020-01-27 08:49:47 -0700934int device_first_child_ofdata_err(struct udevice *parent, struct udevice **devp)
935{
936 struct udevice *dev;
937 int ret;
938
939 device_find_first_child(parent, &dev);
940 if (!dev)
941 return -ENODEV;
942
Simon Glassaad29ae2020-12-03 16:55:21 -0700943 ret = device_of_to_plat(dev);
Simon Glass000676b2020-01-27 08:49:47 -0700944 if (ret)
945 return ret;
946
947 *devp = dev;
948
949 return 0;
950}
951
952int device_next_child_ofdata_err(struct udevice **devp)
953{
954 struct udevice *dev = *devp;
955 int ret;
956
957 device_find_next_child(&dev);
958 if (!dev)
959 return -ENODEV;
960
Simon Glassaad29ae2020-12-03 16:55:21 -0700961 ret = device_of_to_plat(dev);
Simon Glass000676b2020-01-27 08:49:47 -0700962 if (ret)
963 return ret;
964
965 *devp = dev;
966
967 return 0;
968}
969
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600970struct udevice *dev_get_parent(const struct udevice *child)
Simon Glass43f488a2014-11-11 10:46:19 -0700971{
972 return child->parent;
973}
974
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600975ulong dev_get_driver_data(const struct udevice *dev)
Simon Glass70c3a0e2014-11-11 10:46:18 -0700976{
Simon Glass46227bd2015-03-25 12:21:55 -0600977 return dev->driver_data;
Simon Glass70c3a0e2014-11-11 10:46:18 -0700978}
Simon Glass98fd5d12015-01-25 08:27:04 -0700979
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600980const void *dev_get_driver_ops(const struct udevice *dev)
Przemyslaw Marczakd3ef0d72015-04-15 13:07:24 +0200981{
982 if (!dev || !dev->driver->ops)
983 return NULL;
984
985 return dev->driver->ops;
986}
987
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600988enum uclass_id device_get_uclass_id(const struct udevice *dev)
Simon Glass98fd5d12015-01-25 08:27:04 -0700989{
990 return dev->uclass->uc_drv->id;
991}
Peng Fan99b72352015-02-10 14:46:32 +0800992
Simon Glass2e5e5ec2018-10-01 12:22:06 -0600993const char *dev_get_uclass_name(const struct udevice *dev)
Przemyslaw Marczak5ed2e422015-04-15 13:07:25 +0200994{
995 if (!dev)
996 return NULL;
997
998 return dev->uclass->uc_drv->name;
999}
1000
Simon Glass2e5e5ec2018-10-01 12:22:06 -06001001bool device_has_children(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -06001002{
1003 return !list_empty(&dev->child_head);
1004}
1005
Simon Glass2a580882020-01-27 08:49:36 -07001006bool device_has_active_children(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -06001007{
1008 struct udevice *child;
1009
1010 for (device_find_first_child(dev, &child);
1011 child;
1012 device_find_next_child(&child)) {
1013 if (device_active(child))
1014 return true;
1015 }
1016
1017 return false;
1018}
1019
Simon Glass2a580882020-01-27 08:49:36 -07001020bool device_is_last_sibling(const struct udevice *dev)
Simon Glass40f829a2015-03-25 12:21:57 -06001021{
1022 struct udevice *parent = dev->parent;
1023
1024 if (!parent)
1025 return false;
1026 return list_is_last(&dev->sibling_node, &parent->child_head);
1027}
Simon Glasse3b23e22015-07-30 13:40:39 -06001028
Simon Glass7760ba22016-05-01 13:52:23 -06001029void device_set_name_alloced(struct udevice *dev)
1030{
Simon Glass6211d762020-12-19 10:40:10 -07001031 dev_or_flags(dev, DM_FLAG_NAME_ALLOCED);
Simon Glass7760ba22016-05-01 13:52:23 -06001032}
1033
Simon Glasse3b23e22015-07-30 13:40:39 -06001034int device_set_name(struct udevice *dev, const char *name)
1035{
1036 name = strdup(name);
1037 if (!name)
1038 return -ENOMEM;
1039 dev->name = name;
Simon Glass7760ba22016-05-01 13:52:23 -06001040 device_set_name_alloced(dev);
Simon Glasse3b23e22015-07-30 13:40:39 -06001041
1042 return 0;
1043}
Mugunthan V N4666bd92016-04-28 15:36:02 +05301044
Simon Glassd4f0c942020-12-22 19:30:27 -07001045void dev_set_priv(struct udevice *dev, void *priv)
1046{
Simon Glass541f62c2020-12-22 19:30:30 -07001047 dev->priv_ = priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001048}
1049
1050void dev_set_parent_priv(struct udevice *dev, void *parent_priv)
1051{
Simon Glass541f62c2020-12-22 19:30:30 -07001052 dev->parent_priv_ = parent_priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001053}
1054
1055void dev_set_uclass_priv(struct udevice *dev, void *uclass_priv)
1056{
Simon Glass541f62c2020-12-22 19:30:30 -07001057 dev->uclass_priv_ = uclass_priv;
Simon Glassd4f0c942020-12-22 19:30:27 -07001058}
1059
1060void dev_set_plat(struct udevice *dev, void *plat)
1061{
Simon Glass541f62c2020-12-22 19:30:30 -07001062 dev->plat_ = plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001063}
1064
1065void dev_set_parent_plat(struct udevice *dev, void *parent_plat)
1066{
Simon Glass541f62c2020-12-22 19:30:30 -07001067 dev->parent_plat_ = parent_plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001068}
1069
1070void dev_set_uclass_plat(struct udevice *dev, void *uclass_plat)
1071{
Simon Glass541f62c2020-12-22 19:30:30 -07001072 dev->uclass_plat_ = uclass_plat;
Simon Glassd4f0c942020-12-22 19:30:27 -07001073}
1074
Marek Vasut7f18c342019-08-31 18:03:28 +02001075#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
Simon Glass2a580882020-01-27 08:49:36 -07001076bool device_is_compatible(const struct udevice *dev, const char *compat)
Mugunthan V N4666bd92016-04-28 15:36:02 +05301077{
Masahiro Yamada9349bcc2018-04-19 12:14:02 +09001078 return ofnode_device_is_compatible(dev_ofnode(dev), compat);
Mugunthan V N4666bd92016-04-28 15:36:02 +05301079}
1080
1081bool of_machine_is_compatible(const char *compat)
1082{
1083 const void *fdt = gd->fdt_blob;
1084
1085 return !fdt_node_check_compatible(fdt, 0, compat);
1086}
Mario Six3bedfbe2018-06-26 08:46:50 +02001087
1088int dev_disable_by_path(const char *path)
1089{
1090 struct uclass *uc;
1091 ofnode node = ofnode_path(path);
1092 struct udevice *dev;
1093 int ret = 1;
1094
1095 if (!of_live_active())
1096 return -ENOSYS;
1097
Simon Glass784cd9e2020-12-19 10:40:17 -07001098 list_for_each_entry(uc, gd->uclass_root, sibling_node) {
Mario Six3bedfbe2018-06-26 08:46:50 +02001099 ret = uclass_find_device_by_ofnode(uc->uc_drv->id, node, &dev);
1100 if (!ret)
1101 break;
1102 }
1103
1104 if (ret)
1105 return ret;
1106
1107 ret = device_remove(dev, DM_REMOVE_NORMAL);
1108 if (ret)
1109 return ret;
1110
1111 ret = device_unbind(dev);
1112 if (ret)
1113 return ret;
1114
1115 return ofnode_set_enabled(node, false);
1116}
1117
1118int dev_enable_by_path(const char *path)
1119{
1120 ofnode node = ofnode_path(path);
1121 ofnode pnode = ofnode_get_parent(node);
1122 struct udevice *parent;
1123 int ret = 1;
1124
1125 if (!of_live_active())
1126 return -ENOSYS;
1127
1128 ret = device_find_by_ofnode(pnode, &parent);
1129 if (ret)
1130 return ret;
1131
1132 ret = ofnode_set_enabled(node, true);
1133 if (ret)
1134 return ret;
1135
Bin Meng9a9b0742018-10-10 22:06:58 -07001136 return lists_bind_fdt(parent, node, NULL, false);
Mario Six3bedfbe2018-06-26 08:46:50 +02001137}
Marek Vasut7f18c342019-08-31 18:03:28 +02001138#endif