183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+ 26494d708SSimon Glass /* 36494d708SSimon Glass * Copyright (c) 2013 Google, Inc 46494d708SSimon Glass * 56494d708SSimon Glass * (C) Copyright 2012 66494d708SSimon Glass * Pavel Herrmann <morpheus.ibis@gmail.com> 76494d708SSimon Glass */ 86494d708SSimon Glass 96494d708SSimon Glass #include <common.h> 1040bb637dSSimon Glass #include <dm.h> 116494d708SSimon Glass #include <errno.h> 126494d708SSimon Glass #include <malloc.h> 136494d708SSimon Glass #include <dm/device.h> 146494d708SSimon Glass #include <dm/device-internal.h> 156494d708SSimon Glass #include <dm/lists.h> 166494d708SSimon Glass #include <dm/uclass.h> 176494d708SSimon Glass #include <dm/uclass-internal.h> 186494d708SSimon Glass #include <dm/util.h> 196494d708SSimon Glass 206494d708SSimon Glass DECLARE_GLOBAL_DATA_PTR; 216494d708SSimon Glass 226494d708SSimon Glass struct uclass *uclass_find(enum uclass_id key) 236494d708SSimon Glass { 246494d708SSimon Glass struct uclass *uc; 256494d708SSimon Glass 26c910e2e2SSimon Glass if (!gd->dm_root) 27c910e2e2SSimon Glass return NULL; 286494d708SSimon Glass /* 296494d708SSimon Glass * TODO(sjg@chromium.org): Optimise this, perhaps moving the found 306494d708SSimon Glass * node to the start of the list, or creating a linear array mapping 316494d708SSimon Glass * id to node. 326494d708SSimon Glass */ 336494d708SSimon Glass list_for_each_entry(uc, &gd->uclass_root, sibling_node) { 346494d708SSimon Glass if (uc->uc_drv->id == key) 356494d708SSimon Glass return uc; 366494d708SSimon Glass } 376494d708SSimon Glass 386494d708SSimon Glass return NULL; 396494d708SSimon Glass } 406494d708SSimon Glass 416494d708SSimon Glass /** 426494d708SSimon Glass * uclass_add() - Create new uclass in list 436494d708SSimon Glass * @id: Id number to create 446494d708SSimon Glass * @ucp: Returns pointer to uclass, or NULL on error 456494d708SSimon Glass * @return 0 on success, -ve on error 466494d708SSimon Glass * 476494d708SSimon Glass * The new uclass is added to the list. There must be only one uclass for 486494d708SSimon Glass * each id. 496494d708SSimon Glass */ 506494d708SSimon Glass static int uclass_add(enum uclass_id id, struct uclass **ucp) 516494d708SSimon Glass { 526494d708SSimon Glass struct uclass_driver *uc_drv; 536494d708SSimon Glass struct uclass *uc; 546494d708SSimon Glass int ret; 556494d708SSimon Glass 566494d708SSimon Glass *ucp = NULL; 576494d708SSimon Glass uc_drv = lists_uclass_lookup(id); 586494d708SSimon Glass if (!uc_drv) { 59643e6902SMasahiro Yamada debug("Cannot find uclass for id %d: please add the UCLASS_DRIVER() declaration for this UCLASS_... id\n", 606494d708SSimon Glass id); 613346c876SSimon Glass /* 623346c876SSimon Glass * Use a strange error to make this case easier to find. When 633346c876SSimon Glass * a uclass is not available it can prevent driver model from 643346c876SSimon Glass * starting up and this failure is otherwise hard to debug. 653346c876SSimon Glass */ 663346c876SSimon Glass return -EPFNOSUPPORT; 676494d708SSimon Glass } 686494d708SSimon Glass uc = calloc(1, sizeof(*uc)); 696494d708SSimon Glass if (!uc) 706494d708SSimon Glass return -ENOMEM; 716494d708SSimon Glass if (uc_drv->priv_auto_alloc_size) { 726494d708SSimon Glass uc->priv = calloc(1, uc_drv->priv_auto_alloc_size); 736494d708SSimon Glass if (!uc->priv) { 746494d708SSimon Glass ret = -ENOMEM; 756494d708SSimon Glass goto fail_mem; 766494d708SSimon Glass } 776494d708SSimon Glass } 786494d708SSimon Glass uc->uc_drv = uc_drv; 796494d708SSimon Glass INIT_LIST_HEAD(&uc->sibling_node); 806494d708SSimon Glass INIT_LIST_HEAD(&uc->dev_head); 8189876a55SSimon Glass list_add(&uc->sibling_node, &DM_UCLASS_ROOT_NON_CONST); 826494d708SSimon Glass 836494d708SSimon Glass if (uc_drv->init) { 846494d708SSimon Glass ret = uc_drv->init(uc); 856494d708SSimon Glass if (ret) 866494d708SSimon Glass goto fail; 876494d708SSimon Glass } 886494d708SSimon Glass 896494d708SSimon Glass *ucp = uc; 906494d708SSimon Glass 916494d708SSimon Glass return 0; 926494d708SSimon Glass fail: 936494d708SSimon Glass if (uc_drv->priv_auto_alloc_size) { 946494d708SSimon Glass free(uc->priv); 956494d708SSimon Glass uc->priv = NULL; 966494d708SSimon Glass } 976494d708SSimon Glass list_del(&uc->sibling_node); 986494d708SSimon Glass fail_mem: 996494d708SSimon Glass free(uc); 1006494d708SSimon Glass 1016494d708SSimon Glass return ret; 1026494d708SSimon Glass } 1036494d708SSimon Glass 1046494d708SSimon Glass int uclass_destroy(struct uclass *uc) 1056494d708SSimon Glass { 1066494d708SSimon Glass struct uclass_driver *uc_drv; 10707d260e0SSimon Glass struct udevice *dev; 1086494d708SSimon Glass int ret; 1096494d708SSimon Glass 11007d260e0SSimon Glass /* 11107d260e0SSimon Glass * We cannot use list_for_each_entry_safe() here. If a device in this 11207d260e0SSimon Glass * uclass has a child device also in this uclass, it will be also be 11307d260e0SSimon Glass * unbound (by the recursion in the call to device_unbind() below). 11407d260e0SSimon Glass * We can loop until the list is empty. 11507d260e0SSimon Glass */ 11607d260e0SSimon Glass while (!list_empty(&uc->dev_head)) { 11707d260e0SSimon Glass dev = list_first_entry(&uc->dev_head, struct udevice, 11807d260e0SSimon Glass uclass_node); 119706865afSStefan Roese ret = device_remove(dev, DM_REMOVE_NORMAL); 1206494d708SSimon Glass if (ret) 1216494d708SSimon Glass return ret; 1226494d708SSimon Glass ret = device_unbind(dev); 1236494d708SSimon Glass if (ret) 1246494d708SSimon Glass return ret; 1256494d708SSimon Glass } 1266494d708SSimon Glass 1276494d708SSimon Glass uc_drv = uc->uc_drv; 1286494d708SSimon Glass if (uc_drv->destroy) 1296494d708SSimon Glass uc_drv->destroy(uc); 1306494d708SSimon Glass list_del(&uc->sibling_node); 1316494d708SSimon Glass if (uc_drv->priv_auto_alloc_size) 1326494d708SSimon Glass free(uc->priv); 1336494d708SSimon Glass free(uc); 1346494d708SSimon Glass 1356494d708SSimon Glass return 0; 1366494d708SSimon Glass } 1376494d708SSimon Glass 1386494d708SSimon Glass int uclass_get(enum uclass_id id, struct uclass **ucp) 1396494d708SSimon Glass { 1406494d708SSimon Glass struct uclass *uc; 1416494d708SSimon Glass 1426494d708SSimon Glass *ucp = NULL; 1436494d708SSimon Glass uc = uclass_find(id); 1446494d708SSimon Glass if (!uc) 1456494d708SSimon Glass return uclass_add(id, ucp); 1466494d708SSimon Glass *ucp = uc; 1476494d708SSimon Glass 1486494d708SSimon Glass return 0; 1496494d708SSimon Glass } 1506494d708SSimon Glass 1510a5f6f86SSimon Glass const char *uclass_get_name(enum uclass_id id) 1520a5f6f86SSimon Glass { 1530a5f6f86SSimon Glass struct uclass *uc; 1540a5f6f86SSimon Glass 1550a5f6f86SSimon Glass if (uclass_get(id, &uc)) 1560a5f6f86SSimon Glass return NULL; 1570a5f6f86SSimon Glass return uc->uc_drv->name; 1580a5f6f86SSimon Glass } 1590a5f6f86SSimon Glass 1606e43d1b1SSimon Glass enum uclass_id uclass_get_by_name(const char *name) 1616e43d1b1SSimon Glass { 1626e43d1b1SSimon Glass int i; 1636e43d1b1SSimon Glass 1646e43d1b1SSimon Glass for (i = 0; i < UCLASS_COUNT; i++) { 1656e43d1b1SSimon Glass struct uclass_driver *uc_drv = lists_uclass_lookup(i); 1666e43d1b1SSimon Glass 1676e43d1b1SSimon Glass if (uc_drv && !strcmp(uc_drv->name, name)) 1686e43d1b1SSimon Glass return i; 1696e43d1b1SSimon Glass } 1706e43d1b1SSimon Glass 1716e43d1b1SSimon Glass return UCLASS_INVALID; 1726e43d1b1SSimon Glass } 1736e43d1b1SSimon Glass 174e7c86562SJean-Jacques Hiblot int dev_get_uclass_index(struct udevice *dev, struct uclass **ucp) 175e7c86562SJean-Jacques Hiblot { 176e7c86562SJean-Jacques Hiblot struct udevice *iter; 177e7c86562SJean-Jacques Hiblot struct uclass *uc = dev->uclass; 178e7c86562SJean-Jacques Hiblot int i = 0; 179e7c86562SJean-Jacques Hiblot 180e7c86562SJean-Jacques Hiblot if (list_empty(&uc->dev_head)) 181e7c86562SJean-Jacques Hiblot return -ENODEV; 182e7c86562SJean-Jacques Hiblot 18381f351d6SLiviu Dudau uclass_foreach_dev(iter, uc) { 184e7c86562SJean-Jacques Hiblot if (iter == dev) { 185e7c86562SJean-Jacques Hiblot if (ucp) 186e7c86562SJean-Jacques Hiblot *ucp = uc; 187e7c86562SJean-Jacques Hiblot return i; 188e7c86562SJean-Jacques Hiblot } 189e7c86562SJean-Jacques Hiblot i++; 190e7c86562SJean-Jacques Hiblot } 191e7c86562SJean-Jacques Hiblot 192e7c86562SJean-Jacques Hiblot return -ENODEV; 193e7c86562SJean-Jacques Hiblot } 194e7c86562SJean-Jacques Hiblot 19554c5d08aSHeiko Schocher int uclass_find_device(enum uclass_id id, int index, struct udevice **devp) 1966494d708SSimon Glass { 1976494d708SSimon Glass struct uclass *uc; 19854c5d08aSHeiko Schocher struct udevice *dev; 1996494d708SSimon Glass int ret; 2006494d708SSimon Glass 2016494d708SSimon Glass *devp = NULL; 2026494d708SSimon Glass ret = uclass_get(id, &uc); 2036494d708SSimon Glass if (ret) 2046494d708SSimon Glass return ret; 2052fda14aeSSimon Glass if (list_empty(&uc->dev_head)) 2062fda14aeSSimon Glass return -ENODEV; 2076494d708SSimon Glass 20881f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 2096494d708SSimon Glass if (!index--) { 2106494d708SSimon Glass *devp = dev; 2116494d708SSimon Glass return 0; 2126494d708SSimon Glass } 2136494d708SSimon Glass } 2146494d708SSimon Glass 2156494d708SSimon Glass return -ENODEV; 2166494d708SSimon Glass } 2176494d708SSimon Glass 218c1d6f919SPrzemyslaw Marczak int uclass_find_first_device(enum uclass_id id, struct udevice **devp) 219c1d6f919SPrzemyslaw Marczak { 220c1d6f919SPrzemyslaw Marczak struct uclass *uc; 221c1d6f919SPrzemyslaw Marczak int ret; 222c1d6f919SPrzemyslaw Marczak 223c1d6f919SPrzemyslaw Marczak *devp = NULL; 224c1d6f919SPrzemyslaw Marczak ret = uclass_get(id, &uc); 225c1d6f919SPrzemyslaw Marczak if (ret) 226c1d6f919SPrzemyslaw Marczak return ret; 227c1d6f919SPrzemyslaw Marczak if (list_empty(&uc->dev_head)) 228*f3885649SMarcel Ziswiler return -ENODEV; 229c1d6f919SPrzemyslaw Marczak 230c1d6f919SPrzemyslaw Marczak *devp = list_first_entry(&uc->dev_head, struct udevice, uclass_node); 231c1d6f919SPrzemyslaw Marczak 232c1d6f919SPrzemyslaw Marczak return 0; 233c1d6f919SPrzemyslaw Marczak } 234c1d6f919SPrzemyslaw Marczak 235c1d6f919SPrzemyslaw Marczak int uclass_find_next_device(struct udevice **devp) 236c1d6f919SPrzemyslaw Marczak { 237c1d6f919SPrzemyslaw Marczak struct udevice *dev = *devp; 238c1d6f919SPrzemyslaw Marczak 239c1d6f919SPrzemyslaw Marczak *devp = NULL; 240c1d6f919SPrzemyslaw Marczak if (list_is_last(&dev->uclass_node, &dev->uclass->dev_head)) 241c1d6f919SPrzemyslaw Marczak return 0; 242c1d6f919SPrzemyslaw Marczak 243c1d6f919SPrzemyslaw Marczak *devp = list_entry(dev->uclass_node.next, struct udevice, uclass_node); 244c1d6f919SPrzemyslaw Marczak 245c1d6f919SPrzemyslaw Marczak return 0; 246c1d6f919SPrzemyslaw Marczak } 247c1d6f919SPrzemyslaw Marczak 248e0735a4cSPrzemyslaw Marczak int uclass_find_device_by_name(enum uclass_id id, const char *name, 249e0735a4cSPrzemyslaw Marczak struct udevice **devp) 250e0735a4cSPrzemyslaw Marczak { 251e0735a4cSPrzemyslaw Marczak struct uclass *uc; 252e0735a4cSPrzemyslaw Marczak struct udevice *dev; 253e0735a4cSPrzemyslaw Marczak int ret; 254e0735a4cSPrzemyslaw Marczak 255e0735a4cSPrzemyslaw Marczak *devp = NULL; 256e0735a4cSPrzemyslaw Marczak if (!name) 257e0735a4cSPrzemyslaw Marczak return -EINVAL; 258e0735a4cSPrzemyslaw Marczak ret = uclass_get(id, &uc); 259e0735a4cSPrzemyslaw Marczak if (ret) 260e0735a4cSPrzemyslaw Marczak return ret; 261e0735a4cSPrzemyslaw Marczak 26281f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 263e0735a4cSPrzemyslaw Marczak if (!strncmp(dev->name, name, strlen(name))) { 264e0735a4cSPrzemyslaw Marczak *devp = dev; 265e0735a4cSPrzemyslaw Marczak return 0; 266e0735a4cSPrzemyslaw Marczak } 267e0735a4cSPrzemyslaw Marczak } 268e0735a4cSPrzemyslaw Marczak 269e0735a4cSPrzemyslaw Marczak return -ENODEV; 270e0735a4cSPrzemyslaw Marczak } 271e0735a4cSPrzemyslaw Marczak 2723542ff29SJean-Jacques Hiblot #if !CONFIG_IS_ENABLED(OF_CONTROL) || CONFIG_IS_ENABLED(OF_PLATDATA) 2733542ff29SJean-Jacques Hiblot int uclass_find_next_free_req_seq(enum uclass_id id) 2743542ff29SJean-Jacques Hiblot { 2753542ff29SJean-Jacques Hiblot struct uclass *uc; 2763542ff29SJean-Jacques Hiblot struct udevice *dev; 2773542ff29SJean-Jacques Hiblot int ret; 2783542ff29SJean-Jacques Hiblot int max = -1; 2793542ff29SJean-Jacques Hiblot 2803542ff29SJean-Jacques Hiblot ret = uclass_get(id, &uc); 2813542ff29SJean-Jacques Hiblot if (ret) 2823542ff29SJean-Jacques Hiblot return ret; 2833542ff29SJean-Jacques Hiblot 2843542ff29SJean-Jacques Hiblot list_for_each_entry(dev, &uc->dev_head, uclass_node) { 2853542ff29SJean-Jacques Hiblot if ((dev->req_seq != -1) && (dev->req_seq > max)) 2863542ff29SJean-Jacques Hiblot max = dev->req_seq; 2873542ff29SJean-Jacques Hiblot } 2883542ff29SJean-Jacques Hiblot 2893542ff29SJean-Jacques Hiblot if (max == -1) 2903542ff29SJean-Jacques Hiblot return 0; 2913542ff29SJean-Jacques Hiblot 2923542ff29SJean-Jacques Hiblot return max + 1; 2933542ff29SJean-Jacques Hiblot } 2943542ff29SJean-Jacques Hiblot #endif 2953542ff29SJean-Jacques Hiblot 2965a66a8ffSSimon Glass int uclass_find_device_by_seq(enum uclass_id id, int seq_or_req_seq, 2975a66a8ffSSimon Glass bool find_req_seq, struct udevice **devp) 2985a66a8ffSSimon Glass { 2995a66a8ffSSimon Glass struct uclass *uc; 3005a66a8ffSSimon Glass struct udevice *dev; 3015a66a8ffSSimon Glass int ret; 3025a66a8ffSSimon Glass 3035a66a8ffSSimon Glass *devp = NULL; 3045a66a8ffSSimon Glass debug("%s: %d %d\n", __func__, find_req_seq, seq_or_req_seq); 3055a66a8ffSSimon Glass if (seq_or_req_seq == -1) 3065a66a8ffSSimon Glass return -ENODEV; 3075a66a8ffSSimon Glass ret = uclass_get(id, &uc); 3085a66a8ffSSimon Glass if (ret) 3095a66a8ffSSimon Glass return ret; 3105a66a8ffSSimon Glass 31181f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 312ea168e33SAlexandru Gagniuc debug(" - %d %d '%s'\n", dev->req_seq, dev->seq, dev->name); 3135a66a8ffSSimon Glass if ((find_req_seq ? dev->req_seq : dev->seq) == 3145a66a8ffSSimon Glass seq_or_req_seq) { 3155a66a8ffSSimon Glass *devp = dev; 3165a66a8ffSSimon Glass debug(" - found\n"); 3175a66a8ffSSimon Glass return 0; 3185a66a8ffSSimon Glass } 3195a66a8ffSSimon Glass } 3205a66a8ffSSimon Glass debug(" - not found\n"); 3215a66a8ffSSimon Glass 3225a66a8ffSSimon Glass return -ENODEV; 3235a66a8ffSSimon Glass } 3245a66a8ffSSimon Glass 3251b30d61dSSimon Glass int uclass_find_device_by_of_offset(enum uclass_id id, int node, 326f4cdead2SSimon Glass struct udevice **devp) 327f4cdead2SSimon Glass { 328f4cdead2SSimon Glass struct uclass *uc; 329f4cdead2SSimon Glass struct udevice *dev; 330f4cdead2SSimon Glass int ret; 331f4cdead2SSimon Glass 332f4cdead2SSimon Glass *devp = NULL; 333f4cdead2SSimon Glass if (node < 0) 334f4cdead2SSimon Glass return -ENODEV; 335f4cdead2SSimon Glass ret = uclass_get(id, &uc); 336f4cdead2SSimon Glass if (ret) 337f4cdead2SSimon Glass return ret; 338f4cdead2SSimon Glass 33981f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 340e160f7d4SSimon Glass if (dev_of_offset(dev) == node) { 341f4cdead2SSimon Glass *devp = dev; 342f4cdead2SSimon Glass return 0; 343f4cdead2SSimon Glass } 344f4cdead2SSimon Glass } 345f4cdead2SSimon Glass 346f4cdead2SSimon Glass return -ENODEV; 347f4cdead2SSimon Glass } 348f4cdead2SSimon Glass 34940bb637dSSimon Glass int uclass_find_device_by_ofnode(enum uclass_id id, ofnode node, 35040bb637dSSimon Glass struct udevice **devp) 35140bb637dSSimon Glass { 35240bb637dSSimon Glass struct uclass *uc; 35340bb637dSSimon Glass struct udevice *dev; 35440bb637dSSimon Glass int ret; 35540bb637dSSimon Glass 35631e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 35740bb637dSSimon Glass *devp = NULL; 35840bb637dSSimon Glass if (!ofnode_valid(node)) 35940bb637dSSimon Glass return -ENODEV; 36040bb637dSSimon Glass ret = uclass_get(id, &uc); 36140bb637dSSimon Glass if (ret) 36240bb637dSSimon Glass return ret; 36340bb637dSSimon Glass 36481f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 36531e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG_CONTENT, " - checking %s\n", 36631e60ffaSSimon Glass dev->name); 36740bb637dSSimon Glass if (ofnode_equal(dev_ofnode(dev), node)) { 36840bb637dSSimon Glass *devp = dev; 36931e60ffaSSimon Glass goto done; 37040bb637dSSimon Glass } 37140bb637dSSimon Glass } 37231e60ffaSSimon Glass ret = -ENODEV; 37340bb637dSSimon Glass 37431e60ffaSSimon Glass done: 37531e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 37631e60ffaSSimon Glass ofnode_get_name(node), *devp ? (*devp)->name : "(none)", ret); 37731e60ffaSSimon Glass return ret; 37840bb637dSSimon Glass } 37940bb637dSSimon Glass 380c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 381d0b4f68dSSimon Glass int uclass_find_device_by_phandle(enum uclass_id id, struct udevice *parent, 382d0b4f68dSSimon Glass const char *name, struct udevice **devp) 383d82ba4c0SSimon Glass { 384d82ba4c0SSimon Glass struct udevice *dev; 385d82ba4c0SSimon Glass struct uclass *uc; 386d82ba4c0SSimon Glass int find_phandle; 387d82ba4c0SSimon Glass int ret; 388d82ba4c0SSimon Glass 389d82ba4c0SSimon Glass *devp = NULL; 390a40cc8e1SSimon Glass find_phandle = dev_read_u32_default(parent, name, -1); 391d82ba4c0SSimon Glass if (find_phandle <= 0) 392d82ba4c0SSimon Glass return -ENOENT; 393d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 394d82ba4c0SSimon Glass if (ret) 395d82ba4c0SSimon Glass return ret; 396d82ba4c0SSimon Glass 39781f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 398e160f7d4SSimon Glass uint phandle; 399e160f7d4SSimon Glass 400a40cc8e1SSimon Glass phandle = dev_read_phandle(dev); 401d82ba4c0SSimon Glass 402d82ba4c0SSimon Glass if (phandle == find_phandle) { 403d82ba4c0SSimon Glass *devp = dev; 404d82ba4c0SSimon Glass return 0; 405d82ba4c0SSimon Glass } 406d82ba4c0SSimon Glass } 407d82ba4c0SSimon Glass 408d82ba4c0SSimon Glass return -ENODEV; 409d82ba4c0SSimon Glass } 410c275dfefSSimon Glass #endif 411d82ba4c0SSimon Glass 412c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 413c57f806bSSimon Glass const struct driver *find_drv, 414c57f806bSSimon Glass struct udevice **devp) 415c57f806bSSimon Glass { 416c57f806bSSimon Glass struct udevice *dev; 417c57f806bSSimon Glass struct uclass *uc; 418c57f806bSSimon Glass int ret; 419c57f806bSSimon Glass 420c57f806bSSimon Glass ret = uclass_get(id, &uc); 421c57f806bSSimon Glass if (ret) 422c57f806bSSimon Glass return ret; 423c57f806bSSimon Glass 42481f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 425c57f806bSSimon Glass if (dev->driver == find_drv) 426c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 427c57f806bSSimon Glass } 428c57f806bSSimon Glass 429c57f806bSSimon Glass return -ENODEV; 430c57f806bSSimon Glass } 431c57f806bSSimon Glass 43230a570a9SSimon Glass int uclass_get_device_tail(struct udevice *dev, int ret, struct udevice **devp) 4336494d708SSimon Glass { 4346494d708SSimon Glass if (ret) 4356494d708SSimon Glass return ret; 4366494d708SSimon Glass 437f66529f9SSimon Glass assert(dev); 4386494d708SSimon Glass ret = device_probe(dev); 4396494d708SSimon Glass if (ret) 4406494d708SSimon Glass return ret; 4416494d708SSimon Glass 4426494d708SSimon Glass *devp = dev; 4436494d708SSimon Glass 4446494d708SSimon Glass return 0; 4456494d708SSimon Glass } 4466494d708SSimon Glass 4479ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 4489ca296a1SSimon Glass { 4499ca296a1SSimon Glass struct udevice *dev; 4509ca296a1SSimon Glass int ret; 4519ca296a1SSimon Glass 4529ca296a1SSimon Glass *devp = NULL; 4539ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 4549ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 4559ca296a1SSimon Glass } 4569ca296a1SSimon Glass 457b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 458b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 459b7af1a2dSPrzemyslaw Marczak { 460b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 461b7af1a2dSPrzemyslaw Marczak int ret; 462b7af1a2dSPrzemyslaw Marczak 463b7af1a2dSPrzemyslaw Marczak *devp = NULL; 464b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 465b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 466b7af1a2dSPrzemyslaw Marczak } 467b7af1a2dSPrzemyslaw Marczak 4685a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 4695a66a8ffSSimon Glass { 4705a66a8ffSSimon Glass struct udevice *dev; 4715a66a8ffSSimon Glass int ret; 4725a66a8ffSSimon Glass 4735a66a8ffSSimon Glass *devp = NULL; 4745a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 4755a66a8ffSSimon Glass if (ret == -ENODEV) { 4765a66a8ffSSimon Glass /* 4775a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 4785a66a8ffSSimon Glass * that will request this seq if probed. 4795a66a8ffSSimon Glass */ 4805a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 4815a66a8ffSSimon Glass } 4825a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 4835a66a8ffSSimon Glass } 4845a66a8ffSSimon Glass 485f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 486f4cdead2SSimon Glass struct udevice **devp) 487f4cdead2SSimon Glass { 488f4cdead2SSimon Glass struct udevice *dev; 489f4cdead2SSimon Glass int ret; 490f4cdead2SSimon Glass 491f4cdead2SSimon Glass *devp = NULL; 492f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 493f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 494f4cdead2SSimon Glass } 495f4cdead2SSimon Glass 49640bb637dSSimon Glass int uclass_get_device_by_ofnode(enum uclass_id id, ofnode node, 49740bb637dSSimon Glass struct udevice **devp) 49840bb637dSSimon Glass { 49940bb637dSSimon Glass struct udevice *dev; 50040bb637dSSimon Glass int ret; 50140bb637dSSimon Glass 50231e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 50340bb637dSSimon Glass *devp = NULL; 50440bb637dSSimon Glass ret = uclass_find_device_by_ofnode(id, node, &dev); 50531e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 50631e60ffaSSimon Glass ofnode_get_name(node), dev ? dev->name : "(none)", ret); 50740bb637dSSimon Glass 50840bb637dSSimon Glass return uclass_get_device_tail(dev, ret, devp); 50940bb637dSSimon Glass } 51040bb637dSSimon Glass 511c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 512d255fadeSKever Yang int uclass_get_device_by_phandle_id(enum uclass_id id, uint phandle_id, 513d255fadeSKever Yang struct udevice **devp) 514d255fadeSKever Yang { 515d255fadeSKever Yang struct udevice *dev; 516d255fadeSKever Yang struct uclass *uc; 517d255fadeSKever Yang int ret; 518d255fadeSKever Yang 519d255fadeSKever Yang *devp = NULL; 520d255fadeSKever Yang ret = uclass_get(id, &uc); 521d255fadeSKever Yang if (ret) 522d255fadeSKever Yang return ret; 523d255fadeSKever Yang 52481f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 525d255fadeSKever Yang uint phandle; 526d255fadeSKever Yang 527d255fadeSKever Yang phandle = dev_read_phandle(dev); 528d255fadeSKever Yang 529d255fadeSKever Yang if (phandle == phandle_id) { 530d255fadeSKever Yang *devp = dev; 531d255fadeSKever Yang return uclass_get_device_tail(dev, ret, devp); 532d255fadeSKever Yang } 533d255fadeSKever Yang } 534d255fadeSKever Yang 535d255fadeSKever Yang return -ENODEV; 536d255fadeSKever Yang } 537d255fadeSKever Yang 538d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 539d82ba4c0SSimon Glass const char *name, struct udevice **devp) 540d82ba4c0SSimon Glass { 541d82ba4c0SSimon Glass struct udevice *dev; 542d82ba4c0SSimon Glass int ret; 543d82ba4c0SSimon Glass 544d82ba4c0SSimon Glass *devp = NULL; 545d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 546d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 547d82ba4c0SSimon Glass } 548c275dfefSSimon Glass #endif 549d82ba4c0SSimon Glass 55054c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 5516494d708SSimon Glass { 55254c5d08aSHeiko Schocher struct udevice *dev; 5536494d708SSimon Glass int ret; 5546494d708SSimon Glass 5556494d708SSimon Glass *devp = NULL; 556c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 557f66529f9SSimon Glass if (!dev) 558f66529f9SSimon Glass return 0; 559c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5606494d708SSimon Glass } 5616494d708SSimon Glass 562b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 563b0675050SSimon Glass { 564b0675050SSimon Glass int ret; 565b0675050SSimon Glass 566b0675050SSimon Glass ret = uclass_first_device(id, devp); 567b0675050SSimon Glass if (ret) 568b0675050SSimon Glass return ret; 569b0675050SSimon Glass else if (!*devp) 570b0675050SSimon Glass return -ENODEV; 571b0675050SSimon Glass 572b0675050SSimon Glass return 0; 573b0675050SSimon Glass } 574b0675050SSimon Glass 57554c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 5766494d708SSimon Glass { 57754c5d08aSHeiko Schocher struct udevice *dev = *devp; 5786494d708SSimon Glass int ret; 5796494d708SSimon Glass 5806494d708SSimon Glass *devp = NULL; 581c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 582f66529f9SSimon Glass if (!dev) 583f66529f9SSimon Glass return 0; 584c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5856494d708SSimon Glass } 5866494d708SSimon Glass 587f6abd538SPatrice Chotard int uclass_next_device_err(struct udevice **devp) 588f6abd538SPatrice Chotard { 589f6abd538SPatrice Chotard int ret; 590f6abd538SPatrice Chotard 591f6abd538SPatrice Chotard ret = uclass_next_device(devp); 592f6abd538SPatrice Chotard if (ret) 593f6abd538SPatrice Chotard return ret; 594f6abd538SPatrice Chotard else if (!*devp) 595f6abd538SPatrice Chotard return -ENODEV; 596f6abd538SPatrice Chotard 597f6abd538SPatrice Chotard return 0; 598f6abd538SPatrice Chotard } 599f6abd538SPatrice Chotard 60095ce385aSSimon Glass int uclass_first_device_check(enum uclass_id id, struct udevice **devp) 60195ce385aSSimon Glass { 60295ce385aSSimon Glass int ret; 60395ce385aSSimon Glass 60495ce385aSSimon Glass *devp = NULL; 60595ce385aSSimon Glass ret = uclass_find_first_device(id, devp); 60695ce385aSSimon Glass if (ret) 60795ce385aSSimon Glass return ret; 60895ce385aSSimon Glass if (!*devp) 60995ce385aSSimon Glass return 0; 61095ce385aSSimon Glass 61195ce385aSSimon Glass return device_probe(*devp); 61295ce385aSSimon Glass } 61395ce385aSSimon Glass 61495ce385aSSimon Glass int uclass_next_device_check(struct udevice **devp) 61595ce385aSSimon Glass { 61695ce385aSSimon Glass int ret; 61795ce385aSSimon Glass 61895ce385aSSimon Glass ret = uclass_find_next_device(devp); 61995ce385aSSimon Glass if (ret) 62095ce385aSSimon Glass return ret; 62195ce385aSSimon Glass if (!*devp) 62295ce385aSSimon Glass return 0; 62395ce385aSSimon Glass 62495ce385aSSimon Glass return device_probe(*devp); 62595ce385aSSimon Glass } 62695ce385aSSimon Glass 62754c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 6286494d708SSimon Glass { 6296494d708SSimon Glass struct uclass *uc; 6306494d708SSimon Glass int ret; 6316494d708SSimon Glass 6326494d708SSimon Glass uc = dev->uclass; 6336494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 6346494d708SSimon Glass 635081f2fcbSSimon Glass if (dev->parent) { 636081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 637081f2fcbSSimon Glass 638081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 639081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 640081f2fcbSSimon Glass if (ret) 641081f2fcbSSimon Glass goto err; 642081f2fcbSSimon Glass } 643081f2fcbSSimon Glass } 6446494d708SSimon Glass 6456494d708SSimon Glass return 0; 646081f2fcbSSimon Glass err: 647081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 648081f2fcbSSimon Glass list_del(&dev->uclass_node); 649081f2fcbSSimon Glass 650081f2fcbSSimon Glass return ret; 6516494d708SSimon Glass } 6526494d708SSimon Glass 6530a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 65454c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 6556494d708SSimon Glass { 6566494d708SSimon Glass struct uclass *uc; 6576494d708SSimon Glass int ret; 6586494d708SSimon Glass 6596494d708SSimon Glass uc = dev->uclass; 6606494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 6616494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 6626494d708SSimon Glass if (ret) 6636494d708SSimon Glass return ret; 6646494d708SSimon Glass } 6656494d708SSimon Glass 6666494d708SSimon Glass list_del(&dev->uclass_node); 6676494d708SSimon Glass return 0; 6686494d708SSimon Glass } 6697f9875e7SSimon Glass #endif 6706494d708SSimon Glass 6715a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 6725a66a8ffSSimon Glass { 6735a66a8ffSSimon Glass struct udevice *dup; 6745a66a8ffSSimon Glass int seq; 6755a66a8ffSSimon Glass int ret; 6765a66a8ffSSimon Glass 6775a66a8ffSSimon Glass assert(dev->seq == -1); 6785a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 6795a66a8ffSSimon Glass false, &dup); 6805a66a8ffSSimon Glass if (!ret) { 6815a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 6825a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 6835a66a8ffSSimon Glass } else if (ret == -ENODEV) { 6845a66a8ffSSimon Glass /* Our requested sequence number is available */ 6855a66a8ffSSimon Glass if (dev->req_seq != -1) 6865a66a8ffSSimon Glass return dev->req_seq; 6875a66a8ffSSimon Glass } else { 6885a66a8ffSSimon Glass return ret; 6895a66a8ffSSimon Glass } 6905a66a8ffSSimon Glass 6915a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 6925a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 6935a66a8ffSSimon Glass false, &dup); 6945a66a8ffSSimon Glass if (ret == -ENODEV) 6955a66a8ffSSimon Glass break; 6965a66a8ffSSimon Glass if (ret) 6975a66a8ffSSimon Glass return ret; 6985a66a8ffSSimon Glass } 6995a66a8ffSSimon Glass return seq; 7005a66a8ffSSimon Glass } 7015a66a8ffSSimon Glass 70202c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 70383c7e434SSimon Glass { 70483c7e434SSimon Glass struct uclass_driver *uc_drv; 70502c07b37SSimon Glass int ret; 70602c07b37SSimon Glass 70702c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 70802c07b37SSimon Glass if (uc_drv->pre_probe) { 70902c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 71002c07b37SSimon Glass if (ret) 71102c07b37SSimon Glass return ret; 71202c07b37SSimon Glass } 71383c7e434SSimon Glass 71483c7e434SSimon Glass if (!dev->parent) 71583c7e434SSimon Glass return 0; 71683c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 71783c7e434SSimon Glass if (uc_drv->child_pre_probe) 71883c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 71983c7e434SSimon Glass 72083c7e434SSimon Glass return 0; 72183c7e434SSimon Glass } 72283c7e434SSimon Glass 72354c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 7246494d708SSimon Glass { 725651d0c01SBin Meng struct uclass_driver *uc_drv; 726651d0c01SBin Meng int ret; 7276494d708SSimon Glass 728651d0c01SBin Meng if (dev->parent) { 729651d0c01SBin Meng uc_drv = dev->parent->uclass->uc_drv; 730651d0c01SBin Meng if (uc_drv->child_post_probe) { 731651d0c01SBin Meng ret = uc_drv->child_post_probe(dev); 732651d0c01SBin Meng if (ret) 733651d0c01SBin Meng return ret; 734651d0c01SBin Meng } 735651d0c01SBin Meng } 736651d0c01SBin Meng 737651d0c01SBin Meng uc_drv = dev->uclass->uc_drv; 7386494d708SSimon Glass if (uc_drv->post_probe) 7396494d708SSimon Glass return uc_drv->post_probe(dev); 7406494d708SSimon Glass 7416494d708SSimon Glass return 0; 7426494d708SSimon Glass } 7436494d708SSimon Glass 7440a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 74554c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 7466494d708SSimon Glass { 7476494d708SSimon Glass struct uclass *uc; 7486494d708SSimon Glass int ret; 7496494d708SSimon Glass 7506494d708SSimon Glass uc = dev->uclass; 7516494d708SSimon Glass if (uc->uc_drv->pre_remove) { 7526494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 7536494d708SSimon Glass if (ret) 7546494d708SSimon Glass return ret; 7556494d708SSimon Glass } 7566494d708SSimon Glass 7576494d708SSimon Glass return 0; 7586494d708SSimon Glass } 7597f9875e7SSimon Glass #endif 760