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)) 228c1d6f919SPrzemyslaw Marczak return 0; 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 2725a66a8ffSSimon Glass int uclass_find_device_by_seq(enum uclass_id id, int seq_or_req_seq, 2735a66a8ffSSimon Glass bool find_req_seq, struct udevice **devp) 2745a66a8ffSSimon Glass { 2755a66a8ffSSimon Glass struct uclass *uc; 2765a66a8ffSSimon Glass struct udevice *dev; 2775a66a8ffSSimon Glass int ret; 2785a66a8ffSSimon Glass 2795a66a8ffSSimon Glass *devp = NULL; 2805a66a8ffSSimon Glass debug("%s: %d %d\n", __func__, find_req_seq, seq_or_req_seq); 2815a66a8ffSSimon Glass if (seq_or_req_seq == -1) 2825a66a8ffSSimon Glass return -ENODEV; 2835a66a8ffSSimon Glass ret = uclass_get(id, &uc); 2845a66a8ffSSimon Glass if (ret) 2855a66a8ffSSimon Glass return ret; 2865a66a8ffSSimon Glass 28781f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 288ea168e33SAlexandru Gagniuc debug(" - %d %d '%s'\n", dev->req_seq, dev->seq, dev->name); 2895a66a8ffSSimon Glass if ((find_req_seq ? dev->req_seq : dev->seq) == 2905a66a8ffSSimon Glass seq_or_req_seq) { 2915a66a8ffSSimon Glass *devp = dev; 2925a66a8ffSSimon Glass debug(" - found\n"); 2935a66a8ffSSimon Glass return 0; 2945a66a8ffSSimon Glass } 2955a66a8ffSSimon Glass } 2965a66a8ffSSimon Glass debug(" - not found\n"); 2975a66a8ffSSimon Glass 2985a66a8ffSSimon Glass return -ENODEV; 2995a66a8ffSSimon Glass } 3005a66a8ffSSimon Glass 3011b30d61dSSimon Glass int uclass_find_device_by_of_offset(enum uclass_id id, int node, 302f4cdead2SSimon Glass struct udevice **devp) 303f4cdead2SSimon Glass { 304f4cdead2SSimon Glass struct uclass *uc; 305f4cdead2SSimon Glass struct udevice *dev; 306f4cdead2SSimon Glass int ret; 307f4cdead2SSimon Glass 308f4cdead2SSimon Glass *devp = NULL; 309f4cdead2SSimon Glass if (node < 0) 310f4cdead2SSimon Glass return -ENODEV; 311f4cdead2SSimon Glass ret = uclass_get(id, &uc); 312f4cdead2SSimon Glass if (ret) 313f4cdead2SSimon Glass return ret; 314f4cdead2SSimon Glass 31581f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 316e160f7d4SSimon Glass if (dev_of_offset(dev) == node) { 317f4cdead2SSimon Glass *devp = dev; 318f4cdead2SSimon Glass return 0; 319f4cdead2SSimon Glass } 320f4cdead2SSimon Glass } 321f4cdead2SSimon Glass 322f4cdead2SSimon Glass return -ENODEV; 323f4cdead2SSimon Glass } 324f4cdead2SSimon Glass 32540bb637dSSimon Glass int uclass_find_device_by_ofnode(enum uclass_id id, ofnode node, 32640bb637dSSimon Glass struct udevice **devp) 32740bb637dSSimon Glass { 32840bb637dSSimon Glass struct uclass *uc; 32940bb637dSSimon Glass struct udevice *dev; 33040bb637dSSimon Glass int ret; 33140bb637dSSimon Glass 33231e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 33340bb637dSSimon Glass *devp = NULL; 33440bb637dSSimon Glass if (!ofnode_valid(node)) 33540bb637dSSimon Glass return -ENODEV; 33640bb637dSSimon Glass ret = uclass_get(id, &uc); 33740bb637dSSimon Glass if (ret) 33840bb637dSSimon Glass return ret; 33940bb637dSSimon Glass 34081f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 34131e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG_CONTENT, " - checking %s\n", 34231e60ffaSSimon Glass dev->name); 34340bb637dSSimon Glass if (ofnode_equal(dev_ofnode(dev), node)) { 34440bb637dSSimon Glass *devp = dev; 34531e60ffaSSimon Glass goto done; 34640bb637dSSimon Glass } 34740bb637dSSimon Glass } 34831e60ffaSSimon Glass ret = -ENODEV; 34940bb637dSSimon Glass 35031e60ffaSSimon Glass done: 35131e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 35231e60ffaSSimon Glass ofnode_get_name(node), *devp ? (*devp)->name : "(none)", ret); 35331e60ffaSSimon Glass return ret; 35440bb637dSSimon Glass } 35540bb637dSSimon Glass 356c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 357*d0b4f68dSSimon Glass int uclass_find_device_by_phandle(enum uclass_id id, struct udevice *parent, 358*d0b4f68dSSimon Glass const char *name, struct udevice **devp) 359d82ba4c0SSimon Glass { 360d82ba4c0SSimon Glass struct udevice *dev; 361d82ba4c0SSimon Glass struct uclass *uc; 362d82ba4c0SSimon Glass int find_phandle; 363d82ba4c0SSimon Glass int ret; 364d82ba4c0SSimon Glass 365d82ba4c0SSimon Glass *devp = NULL; 366a40cc8e1SSimon Glass find_phandle = dev_read_u32_default(parent, name, -1); 367d82ba4c0SSimon Glass if (find_phandle <= 0) 368d82ba4c0SSimon Glass return -ENOENT; 369d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 370d82ba4c0SSimon Glass if (ret) 371d82ba4c0SSimon Glass return ret; 372d82ba4c0SSimon Glass 37381f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 374e160f7d4SSimon Glass uint phandle; 375e160f7d4SSimon Glass 376a40cc8e1SSimon Glass phandle = dev_read_phandle(dev); 377d82ba4c0SSimon Glass 378d82ba4c0SSimon Glass if (phandle == find_phandle) { 379d82ba4c0SSimon Glass *devp = dev; 380d82ba4c0SSimon Glass return 0; 381d82ba4c0SSimon Glass } 382d82ba4c0SSimon Glass } 383d82ba4c0SSimon Glass 384d82ba4c0SSimon Glass return -ENODEV; 385d82ba4c0SSimon Glass } 386c275dfefSSimon Glass #endif 387d82ba4c0SSimon Glass 388c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 389c57f806bSSimon Glass const struct driver *find_drv, 390c57f806bSSimon Glass struct udevice **devp) 391c57f806bSSimon Glass { 392c57f806bSSimon Glass struct udevice *dev; 393c57f806bSSimon Glass struct uclass *uc; 394c57f806bSSimon Glass int ret; 395c57f806bSSimon Glass 396c57f806bSSimon Glass ret = uclass_get(id, &uc); 397c57f806bSSimon Glass if (ret) 398c57f806bSSimon Glass return ret; 399c57f806bSSimon Glass 40081f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 401c57f806bSSimon Glass if (dev->driver == find_drv) 402c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 403c57f806bSSimon Glass } 404c57f806bSSimon Glass 405c57f806bSSimon Glass return -ENODEV; 406c57f806bSSimon Glass } 407c57f806bSSimon Glass 40830a570a9SSimon Glass int uclass_get_device_tail(struct udevice *dev, int ret, struct udevice **devp) 4096494d708SSimon Glass { 4106494d708SSimon Glass if (ret) 4116494d708SSimon Glass return ret; 4126494d708SSimon Glass 413f66529f9SSimon Glass assert(dev); 4146494d708SSimon Glass ret = device_probe(dev); 4156494d708SSimon Glass if (ret) 4166494d708SSimon Glass return ret; 4176494d708SSimon Glass 4186494d708SSimon Glass *devp = dev; 4196494d708SSimon Glass 4206494d708SSimon Glass return 0; 4216494d708SSimon Glass } 4226494d708SSimon Glass 4239ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 4249ca296a1SSimon Glass { 4259ca296a1SSimon Glass struct udevice *dev; 4269ca296a1SSimon Glass int ret; 4279ca296a1SSimon Glass 4289ca296a1SSimon Glass *devp = NULL; 4299ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 4309ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 4319ca296a1SSimon Glass } 4329ca296a1SSimon Glass 433b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 434b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 435b7af1a2dSPrzemyslaw Marczak { 436b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 437b7af1a2dSPrzemyslaw Marczak int ret; 438b7af1a2dSPrzemyslaw Marczak 439b7af1a2dSPrzemyslaw Marczak *devp = NULL; 440b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 441b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 442b7af1a2dSPrzemyslaw Marczak } 443b7af1a2dSPrzemyslaw Marczak 4445a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 4455a66a8ffSSimon Glass { 4465a66a8ffSSimon Glass struct udevice *dev; 4475a66a8ffSSimon Glass int ret; 4485a66a8ffSSimon Glass 4495a66a8ffSSimon Glass *devp = NULL; 4505a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 4515a66a8ffSSimon Glass if (ret == -ENODEV) { 4525a66a8ffSSimon Glass /* 4535a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 4545a66a8ffSSimon Glass * that will request this seq if probed. 4555a66a8ffSSimon Glass */ 4565a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 4575a66a8ffSSimon Glass } 4585a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 4595a66a8ffSSimon Glass } 4605a66a8ffSSimon Glass 461f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 462f4cdead2SSimon Glass struct udevice **devp) 463f4cdead2SSimon Glass { 464f4cdead2SSimon Glass struct udevice *dev; 465f4cdead2SSimon Glass int ret; 466f4cdead2SSimon Glass 467f4cdead2SSimon Glass *devp = NULL; 468f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 469f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 470f4cdead2SSimon Glass } 471f4cdead2SSimon Glass 47240bb637dSSimon Glass int uclass_get_device_by_ofnode(enum uclass_id id, ofnode node, 47340bb637dSSimon Glass struct udevice **devp) 47440bb637dSSimon Glass { 47540bb637dSSimon Glass struct udevice *dev; 47640bb637dSSimon Glass int ret; 47740bb637dSSimon Glass 47831e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 47940bb637dSSimon Glass *devp = NULL; 48040bb637dSSimon Glass ret = uclass_find_device_by_ofnode(id, node, &dev); 48131e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 48231e60ffaSSimon Glass ofnode_get_name(node), dev ? dev->name : "(none)", ret); 48340bb637dSSimon Glass 48440bb637dSSimon Glass return uclass_get_device_tail(dev, ret, devp); 48540bb637dSSimon Glass } 48640bb637dSSimon Glass 487c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 488d255fadeSKever Yang int uclass_get_device_by_phandle_id(enum uclass_id id, uint phandle_id, 489d255fadeSKever Yang struct udevice **devp) 490d255fadeSKever Yang { 491d255fadeSKever Yang struct udevice *dev; 492d255fadeSKever Yang struct uclass *uc; 493d255fadeSKever Yang int ret; 494d255fadeSKever Yang 495d255fadeSKever Yang *devp = NULL; 496d255fadeSKever Yang ret = uclass_get(id, &uc); 497d255fadeSKever Yang if (ret) 498d255fadeSKever Yang return ret; 499d255fadeSKever Yang 50081f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 501d255fadeSKever Yang uint phandle; 502d255fadeSKever Yang 503d255fadeSKever Yang phandle = dev_read_phandle(dev); 504d255fadeSKever Yang 505d255fadeSKever Yang if (phandle == phandle_id) { 506d255fadeSKever Yang *devp = dev; 507d255fadeSKever Yang return uclass_get_device_tail(dev, ret, devp); 508d255fadeSKever Yang } 509d255fadeSKever Yang } 510d255fadeSKever Yang 511d255fadeSKever Yang return -ENODEV; 512d255fadeSKever Yang } 513d255fadeSKever Yang 514d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 515d82ba4c0SSimon Glass const char *name, struct udevice **devp) 516d82ba4c0SSimon Glass { 517d82ba4c0SSimon Glass struct udevice *dev; 518d82ba4c0SSimon Glass int ret; 519d82ba4c0SSimon Glass 520d82ba4c0SSimon Glass *devp = NULL; 521d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 522d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 523d82ba4c0SSimon Glass } 524c275dfefSSimon Glass #endif 525d82ba4c0SSimon Glass 52654c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 5276494d708SSimon Glass { 52854c5d08aSHeiko Schocher struct udevice *dev; 5296494d708SSimon Glass int ret; 5306494d708SSimon Glass 5316494d708SSimon Glass *devp = NULL; 532c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 533f66529f9SSimon Glass if (!dev) 534f66529f9SSimon Glass return 0; 535c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5366494d708SSimon Glass } 5376494d708SSimon Glass 538b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 539b0675050SSimon Glass { 540b0675050SSimon Glass int ret; 541b0675050SSimon Glass 542b0675050SSimon Glass ret = uclass_first_device(id, devp); 543b0675050SSimon Glass if (ret) 544b0675050SSimon Glass return ret; 545b0675050SSimon Glass else if (!*devp) 546b0675050SSimon Glass return -ENODEV; 547b0675050SSimon Glass 548b0675050SSimon Glass return 0; 549b0675050SSimon Glass } 550b0675050SSimon Glass 55154c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 5526494d708SSimon Glass { 55354c5d08aSHeiko Schocher struct udevice *dev = *devp; 5546494d708SSimon Glass int ret; 5556494d708SSimon Glass 5566494d708SSimon Glass *devp = NULL; 557c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 558f66529f9SSimon Glass if (!dev) 559f66529f9SSimon Glass return 0; 560c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5616494d708SSimon Glass } 5626494d708SSimon Glass 563f6abd538SPatrice Chotard int uclass_next_device_err(struct udevice **devp) 564f6abd538SPatrice Chotard { 565f6abd538SPatrice Chotard int ret; 566f6abd538SPatrice Chotard 567f6abd538SPatrice Chotard ret = uclass_next_device(devp); 568f6abd538SPatrice Chotard if (ret) 569f6abd538SPatrice Chotard return ret; 570f6abd538SPatrice Chotard else if (!*devp) 571f6abd538SPatrice Chotard return -ENODEV; 572f6abd538SPatrice Chotard 573f6abd538SPatrice Chotard return 0; 574f6abd538SPatrice Chotard } 575f6abd538SPatrice Chotard 57695ce385aSSimon Glass int uclass_first_device_check(enum uclass_id id, struct udevice **devp) 57795ce385aSSimon Glass { 57895ce385aSSimon Glass int ret; 57995ce385aSSimon Glass 58095ce385aSSimon Glass *devp = NULL; 58195ce385aSSimon Glass ret = uclass_find_first_device(id, devp); 58295ce385aSSimon Glass if (ret) 58395ce385aSSimon Glass return ret; 58495ce385aSSimon Glass if (!*devp) 58595ce385aSSimon Glass return 0; 58695ce385aSSimon Glass 58795ce385aSSimon Glass return device_probe(*devp); 58895ce385aSSimon Glass } 58995ce385aSSimon Glass 59095ce385aSSimon Glass int uclass_next_device_check(struct udevice **devp) 59195ce385aSSimon Glass { 59295ce385aSSimon Glass int ret; 59395ce385aSSimon Glass 59495ce385aSSimon Glass ret = uclass_find_next_device(devp); 59595ce385aSSimon Glass if (ret) 59695ce385aSSimon Glass return ret; 59795ce385aSSimon Glass if (!*devp) 59895ce385aSSimon Glass return 0; 59995ce385aSSimon Glass 60095ce385aSSimon Glass return device_probe(*devp); 60195ce385aSSimon Glass } 60295ce385aSSimon Glass 60354c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 6046494d708SSimon Glass { 6056494d708SSimon Glass struct uclass *uc; 6066494d708SSimon Glass int ret; 6076494d708SSimon Glass 6086494d708SSimon Glass uc = dev->uclass; 6096494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 6106494d708SSimon Glass 611081f2fcbSSimon Glass if (dev->parent) { 612081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 613081f2fcbSSimon Glass 614081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 615081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 616081f2fcbSSimon Glass if (ret) 617081f2fcbSSimon Glass goto err; 618081f2fcbSSimon Glass } 619081f2fcbSSimon Glass } 6206494d708SSimon Glass 6216494d708SSimon Glass return 0; 622081f2fcbSSimon Glass err: 623081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 624081f2fcbSSimon Glass list_del(&dev->uclass_node); 625081f2fcbSSimon Glass 626081f2fcbSSimon Glass return ret; 6276494d708SSimon Glass } 6286494d708SSimon Glass 6290a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 63054c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 6316494d708SSimon Glass { 6326494d708SSimon Glass struct uclass *uc; 6336494d708SSimon Glass int ret; 6346494d708SSimon Glass 6356494d708SSimon Glass uc = dev->uclass; 6366494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 6376494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 6386494d708SSimon Glass if (ret) 6396494d708SSimon Glass return ret; 6406494d708SSimon Glass } 6416494d708SSimon Glass 6426494d708SSimon Glass list_del(&dev->uclass_node); 6436494d708SSimon Glass return 0; 6446494d708SSimon Glass } 6457f9875e7SSimon Glass #endif 6466494d708SSimon Glass 6475a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 6485a66a8ffSSimon Glass { 6495a66a8ffSSimon Glass struct udevice *dup; 6505a66a8ffSSimon Glass int seq; 6515a66a8ffSSimon Glass int ret; 6525a66a8ffSSimon Glass 6535a66a8ffSSimon Glass assert(dev->seq == -1); 6545a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 6555a66a8ffSSimon Glass false, &dup); 6565a66a8ffSSimon Glass if (!ret) { 6575a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 6585a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 6595a66a8ffSSimon Glass } else if (ret == -ENODEV) { 6605a66a8ffSSimon Glass /* Our requested sequence number is available */ 6615a66a8ffSSimon Glass if (dev->req_seq != -1) 6625a66a8ffSSimon Glass return dev->req_seq; 6635a66a8ffSSimon Glass } else { 6645a66a8ffSSimon Glass return ret; 6655a66a8ffSSimon Glass } 6665a66a8ffSSimon Glass 6675a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 6685a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 6695a66a8ffSSimon Glass false, &dup); 6705a66a8ffSSimon Glass if (ret == -ENODEV) 6715a66a8ffSSimon Glass break; 6725a66a8ffSSimon Glass if (ret) 6735a66a8ffSSimon Glass return ret; 6745a66a8ffSSimon Glass } 6755a66a8ffSSimon Glass return seq; 6765a66a8ffSSimon Glass } 6775a66a8ffSSimon Glass 67802c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 67983c7e434SSimon Glass { 68083c7e434SSimon Glass struct uclass_driver *uc_drv; 68102c07b37SSimon Glass int ret; 68202c07b37SSimon Glass 68302c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 68402c07b37SSimon Glass if (uc_drv->pre_probe) { 68502c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 68602c07b37SSimon Glass if (ret) 68702c07b37SSimon Glass return ret; 68802c07b37SSimon Glass } 68983c7e434SSimon Glass 69083c7e434SSimon Glass if (!dev->parent) 69183c7e434SSimon Glass return 0; 69283c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 69383c7e434SSimon Glass if (uc_drv->child_pre_probe) 69483c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 69583c7e434SSimon Glass 69683c7e434SSimon Glass return 0; 69783c7e434SSimon Glass } 69883c7e434SSimon Glass 69954c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 7006494d708SSimon Glass { 701651d0c01SBin Meng struct uclass_driver *uc_drv; 702651d0c01SBin Meng int ret; 7036494d708SSimon Glass 704651d0c01SBin Meng if (dev->parent) { 705651d0c01SBin Meng uc_drv = dev->parent->uclass->uc_drv; 706651d0c01SBin Meng if (uc_drv->child_post_probe) { 707651d0c01SBin Meng ret = uc_drv->child_post_probe(dev); 708651d0c01SBin Meng if (ret) 709651d0c01SBin Meng return ret; 710651d0c01SBin Meng } 711651d0c01SBin Meng } 712651d0c01SBin Meng 713651d0c01SBin Meng uc_drv = dev->uclass->uc_drv; 7146494d708SSimon Glass if (uc_drv->post_probe) 7156494d708SSimon Glass return uc_drv->post_probe(dev); 7166494d708SSimon Glass 7176494d708SSimon Glass return 0; 7186494d708SSimon Glass } 7196494d708SSimon Glass 7200a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 72154c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 7226494d708SSimon Glass { 7236494d708SSimon Glass struct uclass *uc; 7246494d708SSimon Glass int ret; 7256494d708SSimon Glass 7266494d708SSimon Glass uc = dev->uclass; 7276494d708SSimon Glass if (uc->uc_drv->pre_remove) { 7286494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 7296494d708SSimon Glass if (ret) 7306494d708SSimon Glass return ret; 7316494d708SSimon Glass } 7326494d708SSimon Glass 7336494d708SSimon Glass return 0; 7346494d708SSimon Glass } 7357f9875e7SSimon Glass #endif 736