16494d708SSimon Glass /* 26494d708SSimon Glass * Copyright (c) 2013 Google, Inc 36494d708SSimon Glass * 46494d708SSimon Glass * (C) Copyright 2012 56494d708SSimon Glass * Pavel Herrmann <morpheus.ibis@gmail.com> 66494d708SSimon Glass * 76494d708SSimon Glass * SPDX-License-Identifier: GPL-2.0+ 86494d708SSimon Glass */ 96494d708SSimon Glass 106494d708SSimon Glass #include <common.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); 1196494d708SSimon Glass ret = device_remove(dev); 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 151*0a5f6f86SSimon Glass const char *uclass_get_name(enum uclass_id id) 152*0a5f6f86SSimon Glass { 153*0a5f6f86SSimon Glass struct uclass *uc; 154*0a5f6f86SSimon Glass 155*0a5f6f86SSimon Glass if (uclass_get(id, &uc)) 156*0a5f6f86SSimon Glass return NULL; 157*0a5f6f86SSimon Glass return uc->uc_drv->name; 158*0a5f6f86SSimon Glass } 159*0a5f6f86SSimon Glass 16054c5d08aSHeiko Schocher int uclass_find_device(enum uclass_id id, int index, struct udevice **devp) 1616494d708SSimon Glass { 1626494d708SSimon Glass struct uclass *uc; 16354c5d08aSHeiko Schocher struct udevice *dev; 1646494d708SSimon Glass int ret; 1656494d708SSimon Glass 1666494d708SSimon Glass *devp = NULL; 1676494d708SSimon Glass ret = uclass_get(id, &uc); 1686494d708SSimon Glass if (ret) 1696494d708SSimon Glass return ret; 1702fda14aeSSimon Glass if (list_empty(&uc->dev_head)) 1712fda14aeSSimon Glass return -ENODEV; 1726494d708SSimon Glass 1736494d708SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 1746494d708SSimon Glass if (!index--) { 1756494d708SSimon Glass *devp = dev; 1766494d708SSimon Glass return 0; 1776494d708SSimon Glass } 1786494d708SSimon Glass } 1796494d708SSimon Glass 1806494d708SSimon Glass return -ENODEV; 1816494d708SSimon Glass } 1826494d708SSimon Glass 183c1d6f919SPrzemyslaw Marczak int uclass_find_first_device(enum uclass_id id, struct udevice **devp) 184c1d6f919SPrzemyslaw Marczak { 185c1d6f919SPrzemyslaw Marczak struct uclass *uc; 186c1d6f919SPrzemyslaw Marczak int ret; 187c1d6f919SPrzemyslaw Marczak 188c1d6f919SPrzemyslaw Marczak *devp = NULL; 189c1d6f919SPrzemyslaw Marczak ret = uclass_get(id, &uc); 190c1d6f919SPrzemyslaw Marczak if (ret) 191c1d6f919SPrzemyslaw Marczak return ret; 192c1d6f919SPrzemyslaw Marczak if (list_empty(&uc->dev_head)) 193c1d6f919SPrzemyslaw Marczak return 0; 194c1d6f919SPrzemyslaw Marczak 195c1d6f919SPrzemyslaw Marczak *devp = list_first_entry(&uc->dev_head, struct udevice, uclass_node); 196c1d6f919SPrzemyslaw Marczak 197c1d6f919SPrzemyslaw Marczak return 0; 198c1d6f919SPrzemyslaw Marczak } 199c1d6f919SPrzemyslaw Marczak 200c1d6f919SPrzemyslaw Marczak int uclass_find_next_device(struct udevice **devp) 201c1d6f919SPrzemyslaw Marczak { 202c1d6f919SPrzemyslaw Marczak struct udevice *dev = *devp; 203c1d6f919SPrzemyslaw Marczak 204c1d6f919SPrzemyslaw Marczak *devp = NULL; 205c1d6f919SPrzemyslaw Marczak if (list_is_last(&dev->uclass_node, &dev->uclass->dev_head)) 206c1d6f919SPrzemyslaw Marczak return 0; 207c1d6f919SPrzemyslaw Marczak 208c1d6f919SPrzemyslaw Marczak *devp = list_entry(dev->uclass_node.next, struct udevice, uclass_node); 209c1d6f919SPrzemyslaw Marczak 210c1d6f919SPrzemyslaw Marczak return 0; 211c1d6f919SPrzemyslaw Marczak } 212c1d6f919SPrzemyslaw Marczak 213e0735a4cSPrzemyslaw Marczak int uclass_find_device_by_name(enum uclass_id id, const char *name, 214e0735a4cSPrzemyslaw Marczak struct udevice **devp) 215e0735a4cSPrzemyslaw Marczak { 216e0735a4cSPrzemyslaw Marczak struct uclass *uc; 217e0735a4cSPrzemyslaw Marczak struct udevice *dev; 218e0735a4cSPrzemyslaw Marczak int ret; 219e0735a4cSPrzemyslaw Marczak 220e0735a4cSPrzemyslaw Marczak *devp = NULL; 221e0735a4cSPrzemyslaw Marczak if (!name) 222e0735a4cSPrzemyslaw Marczak return -EINVAL; 223e0735a4cSPrzemyslaw Marczak ret = uclass_get(id, &uc); 224e0735a4cSPrzemyslaw Marczak if (ret) 225e0735a4cSPrzemyslaw Marczak return ret; 226e0735a4cSPrzemyslaw Marczak 227e0735a4cSPrzemyslaw Marczak list_for_each_entry(dev, &uc->dev_head, uclass_node) { 228e0735a4cSPrzemyslaw Marczak if (!strncmp(dev->name, name, strlen(name))) { 229e0735a4cSPrzemyslaw Marczak *devp = dev; 230e0735a4cSPrzemyslaw Marczak return 0; 231e0735a4cSPrzemyslaw Marczak } 232e0735a4cSPrzemyslaw Marczak } 233e0735a4cSPrzemyslaw Marczak 234e0735a4cSPrzemyslaw Marczak return -ENODEV; 235e0735a4cSPrzemyslaw Marczak } 236e0735a4cSPrzemyslaw Marczak 2375a66a8ffSSimon Glass int uclass_find_device_by_seq(enum uclass_id id, int seq_or_req_seq, 2385a66a8ffSSimon Glass bool find_req_seq, struct udevice **devp) 2395a66a8ffSSimon Glass { 2405a66a8ffSSimon Glass struct uclass *uc; 2415a66a8ffSSimon Glass struct udevice *dev; 2425a66a8ffSSimon Glass int ret; 2435a66a8ffSSimon Glass 2445a66a8ffSSimon Glass *devp = NULL; 2455a66a8ffSSimon Glass debug("%s: %d %d\n", __func__, find_req_seq, seq_or_req_seq); 2465a66a8ffSSimon Glass if (seq_or_req_seq == -1) 2475a66a8ffSSimon Glass return -ENODEV; 2485a66a8ffSSimon Glass ret = uclass_get(id, &uc); 2495a66a8ffSSimon Glass if (ret) 2505a66a8ffSSimon Glass return ret; 2515a66a8ffSSimon Glass 2525a66a8ffSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 2535a66a8ffSSimon Glass debug(" - %d %d\n", dev->req_seq, dev->seq); 2545a66a8ffSSimon Glass if ((find_req_seq ? dev->req_seq : dev->seq) == 2555a66a8ffSSimon Glass seq_or_req_seq) { 2565a66a8ffSSimon Glass *devp = dev; 2575a66a8ffSSimon Glass debug(" - found\n"); 2585a66a8ffSSimon Glass return 0; 2595a66a8ffSSimon Glass } 2605a66a8ffSSimon Glass } 2615a66a8ffSSimon Glass debug(" - not found\n"); 2625a66a8ffSSimon Glass 2635a66a8ffSSimon Glass return -ENODEV; 2645a66a8ffSSimon Glass } 2655a66a8ffSSimon Glass 2661b30d61dSSimon Glass int uclass_find_device_by_of_offset(enum uclass_id id, int node, 267f4cdead2SSimon Glass struct udevice **devp) 268f4cdead2SSimon Glass { 269f4cdead2SSimon Glass struct uclass *uc; 270f4cdead2SSimon Glass struct udevice *dev; 271f4cdead2SSimon Glass int ret; 272f4cdead2SSimon Glass 273f4cdead2SSimon Glass *devp = NULL; 274f4cdead2SSimon Glass if (node < 0) 275f4cdead2SSimon Glass return -ENODEV; 276f4cdead2SSimon Glass ret = uclass_get(id, &uc); 277f4cdead2SSimon Glass if (ret) 278f4cdead2SSimon Glass return ret; 279f4cdead2SSimon Glass 280f4cdead2SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 281f4cdead2SSimon Glass if (dev->of_offset == node) { 282f4cdead2SSimon Glass *devp = dev; 283f4cdead2SSimon Glass return 0; 284f4cdead2SSimon Glass } 285f4cdead2SSimon Glass } 286f4cdead2SSimon Glass 287f4cdead2SSimon Glass return -ENODEV; 288f4cdead2SSimon Glass } 289f4cdead2SSimon Glass 290c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 291d82ba4c0SSimon Glass static int uclass_find_device_by_phandle(enum uclass_id id, 292d82ba4c0SSimon Glass struct udevice *parent, 293d82ba4c0SSimon Glass const char *name, 294d82ba4c0SSimon Glass struct udevice **devp) 295d82ba4c0SSimon Glass { 296d82ba4c0SSimon Glass struct udevice *dev; 297d82ba4c0SSimon Glass struct uclass *uc; 298d82ba4c0SSimon Glass int find_phandle; 299d82ba4c0SSimon Glass int ret; 300d82ba4c0SSimon Glass 301d82ba4c0SSimon Glass *devp = NULL; 302d82ba4c0SSimon Glass find_phandle = fdtdec_get_int(gd->fdt_blob, parent->of_offset, name, 303d82ba4c0SSimon Glass -1); 304d82ba4c0SSimon Glass if (find_phandle <= 0) 305d82ba4c0SSimon Glass return -ENOENT; 306d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 307d82ba4c0SSimon Glass if (ret) 308d82ba4c0SSimon Glass return ret; 309d82ba4c0SSimon Glass 310d82ba4c0SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 311d82ba4c0SSimon Glass uint phandle = fdt_get_phandle(gd->fdt_blob, dev->of_offset); 312d82ba4c0SSimon Glass 313d82ba4c0SSimon Glass if (phandle == find_phandle) { 314d82ba4c0SSimon Glass *devp = dev; 315d82ba4c0SSimon Glass return 0; 316d82ba4c0SSimon Glass } 317d82ba4c0SSimon Glass } 318d82ba4c0SSimon Glass 319d82ba4c0SSimon Glass return -ENODEV; 320d82ba4c0SSimon Glass } 321c275dfefSSimon Glass #endif 322d82ba4c0SSimon Glass 323c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 324c57f806bSSimon Glass const struct driver *find_drv, 325c57f806bSSimon Glass struct udevice **devp) 326c57f806bSSimon Glass { 327c57f806bSSimon Glass struct udevice *dev; 328c57f806bSSimon Glass struct uclass *uc; 329c57f806bSSimon Glass int ret; 330c57f806bSSimon Glass 331c57f806bSSimon Glass ret = uclass_get(id, &uc); 332c57f806bSSimon Glass if (ret) 333c57f806bSSimon Glass return ret; 334c57f806bSSimon Glass 335c57f806bSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 336c57f806bSSimon Glass if (dev->driver == find_drv) 337c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 338c57f806bSSimon Glass } 339c57f806bSSimon Glass 340c57f806bSSimon Glass return -ENODEV; 341c57f806bSSimon Glass } 342c57f806bSSimon Glass 343794d5219SPrzemyslaw Marczak int uclass_get_device_tail(struct udevice *dev, int ret, 3449ca296a1SSimon Glass struct udevice **devp) 3456494d708SSimon Glass { 3466494d708SSimon Glass if (ret) 3476494d708SSimon Glass return ret; 3486494d708SSimon Glass 349f66529f9SSimon Glass assert(dev); 3506494d708SSimon Glass ret = device_probe(dev); 3516494d708SSimon Glass if (ret) 3526494d708SSimon Glass return ret; 3536494d708SSimon Glass 3546494d708SSimon Glass *devp = dev; 3556494d708SSimon Glass 3566494d708SSimon Glass return 0; 3576494d708SSimon Glass } 3586494d708SSimon Glass 3599ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 3609ca296a1SSimon Glass { 3619ca296a1SSimon Glass struct udevice *dev; 3629ca296a1SSimon Glass int ret; 3639ca296a1SSimon Glass 3649ca296a1SSimon Glass *devp = NULL; 3659ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 3669ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 3679ca296a1SSimon Glass } 3689ca296a1SSimon Glass 369b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 370b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 371b7af1a2dSPrzemyslaw Marczak { 372b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 373b7af1a2dSPrzemyslaw Marczak int ret; 374b7af1a2dSPrzemyslaw Marczak 375b7af1a2dSPrzemyslaw Marczak *devp = NULL; 376b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 377b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 378b7af1a2dSPrzemyslaw Marczak } 379b7af1a2dSPrzemyslaw Marczak 3805a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 3815a66a8ffSSimon Glass { 3825a66a8ffSSimon Glass struct udevice *dev; 3835a66a8ffSSimon Glass int ret; 3845a66a8ffSSimon Glass 3855a66a8ffSSimon Glass *devp = NULL; 3865a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 3875a66a8ffSSimon Glass if (ret == -ENODEV) { 3885a66a8ffSSimon Glass /* 3895a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 3905a66a8ffSSimon Glass * that will request this seq if probed. 3915a66a8ffSSimon Glass */ 3925a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 3935a66a8ffSSimon Glass } 3945a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 3955a66a8ffSSimon Glass } 3965a66a8ffSSimon Glass 397f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 398f4cdead2SSimon Glass struct udevice **devp) 399f4cdead2SSimon Glass { 400f4cdead2SSimon Glass struct udevice *dev; 401f4cdead2SSimon Glass int ret; 402f4cdead2SSimon Glass 403f4cdead2SSimon Glass *devp = NULL; 404f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 405f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 406f4cdead2SSimon Glass } 407f4cdead2SSimon Glass 408c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 409d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 410d82ba4c0SSimon Glass const char *name, struct udevice **devp) 411d82ba4c0SSimon Glass { 412d82ba4c0SSimon Glass struct udevice *dev; 413d82ba4c0SSimon Glass int ret; 414d82ba4c0SSimon Glass 415d82ba4c0SSimon Glass *devp = NULL; 416d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 417d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 418d82ba4c0SSimon Glass } 419c275dfefSSimon Glass #endif 420d82ba4c0SSimon Glass 42154c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 4226494d708SSimon Glass { 42354c5d08aSHeiko Schocher struct udevice *dev; 4246494d708SSimon Glass int ret; 4256494d708SSimon Glass 4266494d708SSimon Glass *devp = NULL; 427c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 428f66529f9SSimon Glass if (!dev) 429f66529f9SSimon Glass return 0; 430c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 4316494d708SSimon Glass } 4326494d708SSimon Glass 433b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 434b0675050SSimon Glass { 435b0675050SSimon Glass int ret; 436b0675050SSimon Glass 437b0675050SSimon Glass ret = uclass_first_device(id, devp); 438b0675050SSimon Glass if (ret) 439b0675050SSimon Glass return ret; 440b0675050SSimon Glass else if (!*devp) 441b0675050SSimon Glass return -ENODEV; 442b0675050SSimon Glass 443b0675050SSimon Glass return 0; 444b0675050SSimon Glass } 445b0675050SSimon Glass 44654c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 4476494d708SSimon Glass { 44854c5d08aSHeiko Schocher struct udevice *dev = *devp; 4496494d708SSimon Glass int ret; 4506494d708SSimon Glass 4516494d708SSimon Glass *devp = NULL; 452c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 453f66529f9SSimon Glass if (!dev) 454f66529f9SSimon Glass return 0; 455c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 4566494d708SSimon Glass } 4576494d708SSimon Glass 45854c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 4596494d708SSimon Glass { 4606494d708SSimon Glass struct uclass *uc; 4616494d708SSimon Glass int ret; 4626494d708SSimon Glass 4636494d708SSimon Glass uc = dev->uclass; 4646494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 4656494d708SSimon Glass 466081f2fcbSSimon Glass if (dev->parent) { 467081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 468081f2fcbSSimon Glass 469081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 470081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 471081f2fcbSSimon Glass if (ret) 472081f2fcbSSimon Glass goto err; 473081f2fcbSSimon Glass } 474081f2fcbSSimon Glass } 4756494d708SSimon Glass 4766494d708SSimon Glass return 0; 477081f2fcbSSimon Glass err: 478081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 479081f2fcbSSimon Glass list_del(&dev->uclass_node); 480081f2fcbSSimon Glass 481081f2fcbSSimon Glass return ret; 4826494d708SSimon Glass } 4836494d708SSimon Glass 4840a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 48554c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 4866494d708SSimon Glass { 4876494d708SSimon Glass struct uclass *uc; 4886494d708SSimon Glass int ret; 4896494d708SSimon Glass 4906494d708SSimon Glass uc = dev->uclass; 4916494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 4926494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 4936494d708SSimon Glass if (ret) 4946494d708SSimon Glass return ret; 4956494d708SSimon Glass } 4966494d708SSimon Glass 4976494d708SSimon Glass list_del(&dev->uclass_node); 4986494d708SSimon Glass return 0; 4996494d708SSimon Glass } 5007f9875e7SSimon Glass #endif 5016494d708SSimon Glass 5025a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 5035a66a8ffSSimon Glass { 5045a66a8ffSSimon Glass struct udevice *dup; 5055a66a8ffSSimon Glass int seq; 5065a66a8ffSSimon Glass int ret; 5075a66a8ffSSimon Glass 5085a66a8ffSSimon Glass assert(dev->seq == -1); 5095a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 5105a66a8ffSSimon Glass false, &dup); 5115a66a8ffSSimon Glass if (!ret) { 5125a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 5135a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 5145a66a8ffSSimon Glass } else if (ret == -ENODEV) { 5155a66a8ffSSimon Glass /* Our requested sequence number is available */ 5165a66a8ffSSimon Glass if (dev->req_seq != -1) 5175a66a8ffSSimon Glass return dev->req_seq; 5185a66a8ffSSimon Glass } else { 5195a66a8ffSSimon Glass return ret; 5205a66a8ffSSimon Glass } 5215a66a8ffSSimon Glass 5225a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 5235a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 5245a66a8ffSSimon Glass false, &dup); 5255a66a8ffSSimon Glass if (ret == -ENODEV) 5265a66a8ffSSimon Glass break; 5275a66a8ffSSimon Glass if (ret) 5285a66a8ffSSimon Glass return ret; 5295a66a8ffSSimon Glass } 5305a66a8ffSSimon Glass return seq; 5315a66a8ffSSimon Glass } 5325a66a8ffSSimon Glass 53302c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 53483c7e434SSimon Glass { 53583c7e434SSimon Glass struct uclass_driver *uc_drv; 53602c07b37SSimon Glass int ret; 53702c07b37SSimon Glass 53802c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 53902c07b37SSimon Glass if (uc_drv->pre_probe) { 54002c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 54102c07b37SSimon Glass if (ret) 54202c07b37SSimon Glass return ret; 54302c07b37SSimon Glass } 54483c7e434SSimon Glass 54583c7e434SSimon Glass if (!dev->parent) 54683c7e434SSimon Glass return 0; 54783c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 54883c7e434SSimon Glass if (uc_drv->child_pre_probe) 54983c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 55083c7e434SSimon Glass 55183c7e434SSimon Glass return 0; 55283c7e434SSimon Glass } 55383c7e434SSimon Glass 55454c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 5556494d708SSimon Glass { 5566494d708SSimon Glass struct uclass_driver *uc_drv = dev->uclass->uc_drv; 5576494d708SSimon Glass 5586494d708SSimon Glass if (uc_drv->post_probe) 5596494d708SSimon Glass return uc_drv->post_probe(dev); 5606494d708SSimon Glass 5616494d708SSimon Glass return 0; 5626494d708SSimon Glass } 5636494d708SSimon Glass 5640a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 56554c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 5666494d708SSimon Glass { 5676494d708SSimon Glass struct uclass *uc; 5686494d708SSimon Glass int ret; 5696494d708SSimon Glass 5706494d708SSimon Glass uc = dev->uclass; 5716494d708SSimon Glass if (uc->uc_drv->pre_remove) { 5726494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 5736494d708SSimon Glass if (ret) 5746494d708SSimon Glass return ret; 5756494d708SSimon Glass } 5766494d708SSimon Glass 5776494d708SSimon Glass return 0; 5786494d708SSimon Glass } 5797f9875e7SSimon Glass #endif 580