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) 357d82ba4c0SSimon Glass static int uclass_find_device_by_phandle(enum uclass_id id, 358d82ba4c0SSimon Glass struct udevice *parent, 359d82ba4c0SSimon Glass const char *name, 360d82ba4c0SSimon Glass struct udevice **devp) 361d82ba4c0SSimon Glass { 362d82ba4c0SSimon Glass struct udevice *dev; 363d82ba4c0SSimon Glass struct uclass *uc; 364d82ba4c0SSimon Glass int find_phandle; 365d82ba4c0SSimon Glass int ret; 366d82ba4c0SSimon Glass 367d82ba4c0SSimon Glass *devp = NULL; 368a40cc8e1SSimon Glass find_phandle = dev_read_u32_default(parent, name, -1); 369d82ba4c0SSimon Glass if (find_phandle <= 0) 370d82ba4c0SSimon Glass return -ENOENT; 371d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 372d82ba4c0SSimon Glass if (ret) 373d82ba4c0SSimon Glass return ret; 374d82ba4c0SSimon Glass 37581f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 376e160f7d4SSimon Glass uint phandle; 377e160f7d4SSimon Glass 378a40cc8e1SSimon Glass phandle = dev_read_phandle(dev); 379d82ba4c0SSimon Glass 380d82ba4c0SSimon Glass if (phandle == find_phandle) { 381d82ba4c0SSimon Glass *devp = dev; 382d82ba4c0SSimon Glass return 0; 383d82ba4c0SSimon Glass } 384d82ba4c0SSimon Glass } 385d82ba4c0SSimon Glass 386d82ba4c0SSimon Glass return -ENODEV; 387d82ba4c0SSimon Glass } 388c275dfefSSimon Glass #endif 389d82ba4c0SSimon Glass 390c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 391c57f806bSSimon Glass const struct driver *find_drv, 392c57f806bSSimon Glass struct udevice **devp) 393c57f806bSSimon Glass { 394c57f806bSSimon Glass struct udevice *dev; 395c57f806bSSimon Glass struct uclass *uc; 396c57f806bSSimon Glass int ret; 397c57f806bSSimon Glass 398c57f806bSSimon Glass ret = uclass_get(id, &uc); 399c57f806bSSimon Glass if (ret) 400c57f806bSSimon Glass return ret; 401c57f806bSSimon Glass 40281f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 403c57f806bSSimon Glass if (dev->driver == find_drv) 404c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 405c57f806bSSimon Glass } 406c57f806bSSimon Glass 407c57f806bSSimon Glass return -ENODEV; 408c57f806bSSimon Glass } 409c57f806bSSimon Glass 41030a570a9SSimon Glass int uclass_get_device_tail(struct udevice *dev, int ret, struct udevice **devp) 4116494d708SSimon Glass { 4126494d708SSimon Glass if (ret) 4136494d708SSimon Glass return ret; 4146494d708SSimon Glass 415f66529f9SSimon Glass assert(dev); 4166494d708SSimon Glass ret = device_probe(dev); 4176494d708SSimon Glass if (ret) 4186494d708SSimon Glass return ret; 4196494d708SSimon Glass 4206494d708SSimon Glass *devp = dev; 4216494d708SSimon Glass 4226494d708SSimon Glass return 0; 4236494d708SSimon Glass } 4246494d708SSimon Glass 4259ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 4269ca296a1SSimon Glass { 4279ca296a1SSimon Glass struct udevice *dev; 4289ca296a1SSimon Glass int ret; 4299ca296a1SSimon Glass 4309ca296a1SSimon Glass *devp = NULL; 4319ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 4329ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 4339ca296a1SSimon Glass } 4349ca296a1SSimon Glass 435b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 436b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 437b7af1a2dSPrzemyslaw Marczak { 438b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 439b7af1a2dSPrzemyslaw Marczak int ret; 440b7af1a2dSPrzemyslaw Marczak 441b7af1a2dSPrzemyslaw Marczak *devp = NULL; 442b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 443b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 444b7af1a2dSPrzemyslaw Marczak } 445b7af1a2dSPrzemyslaw Marczak 4465a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 4475a66a8ffSSimon Glass { 4485a66a8ffSSimon Glass struct udevice *dev; 4495a66a8ffSSimon Glass int ret; 4505a66a8ffSSimon Glass 4515a66a8ffSSimon Glass *devp = NULL; 4525a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 4535a66a8ffSSimon Glass if (ret == -ENODEV) { 4545a66a8ffSSimon Glass /* 4555a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 4565a66a8ffSSimon Glass * that will request this seq if probed. 4575a66a8ffSSimon Glass */ 4585a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 4595a66a8ffSSimon Glass } 4605a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 4615a66a8ffSSimon Glass } 4625a66a8ffSSimon Glass 463f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 464f4cdead2SSimon Glass struct udevice **devp) 465f4cdead2SSimon Glass { 466f4cdead2SSimon Glass struct udevice *dev; 467f4cdead2SSimon Glass int ret; 468f4cdead2SSimon Glass 469f4cdead2SSimon Glass *devp = NULL; 470f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 471f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 472f4cdead2SSimon Glass } 473f4cdead2SSimon Glass 47440bb637dSSimon Glass int uclass_get_device_by_ofnode(enum uclass_id id, ofnode node, 47540bb637dSSimon Glass struct udevice **devp) 47640bb637dSSimon Glass { 47740bb637dSSimon Glass struct udevice *dev; 47840bb637dSSimon Glass int ret; 47940bb637dSSimon Glass 48031e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 48140bb637dSSimon Glass *devp = NULL; 48240bb637dSSimon Glass ret = uclass_find_device_by_ofnode(id, node, &dev); 48331e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 48431e60ffaSSimon Glass ofnode_get_name(node), dev ? dev->name : "(none)", ret); 48540bb637dSSimon Glass 48640bb637dSSimon Glass return uclass_get_device_tail(dev, ret, devp); 48740bb637dSSimon Glass } 48840bb637dSSimon Glass 489c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 490d255fadeSKever Yang int uclass_get_device_by_phandle_id(enum uclass_id id, uint phandle_id, 491d255fadeSKever Yang struct udevice **devp) 492d255fadeSKever Yang { 493d255fadeSKever Yang struct udevice *dev; 494d255fadeSKever Yang struct uclass *uc; 495d255fadeSKever Yang int ret; 496d255fadeSKever Yang 497d255fadeSKever Yang *devp = NULL; 498d255fadeSKever Yang ret = uclass_get(id, &uc); 499d255fadeSKever Yang if (ret) 500d255fadeSKever Yang return ret; 501d255fadeSKever Yang 50281f351d6SLiviu Dudau uclass_foreach_dev(dev, uc) { 503d255fadeSKever Yang uint phandle; 504d255fadeSKever Yang 505d255fadeSKever Yang phandle = dev_read_phandle(dev); 506d255fadeSKever Yang 507d255fadeSKever Yang if (phandle == phandle_id) { 508d255fadeSKever Yang *devp = dev; 509d255fadeSKever Yang return uclass_get_device_tail(dev, ret, devp); 510d255fadeSKever Yang } 511d255fadeSKever Yang } 512d255fadeSKever Yang 513d255fadeSKever Yang return -ENODEV; 514d255fadeSKever Yang } 515d255fadeSKever Yang 516d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 517d82ba4c0SSimon Glass const char *name, struct udevice **devp) 518d82ba4c0SSimon Glass { 519d82ba4c0SSimon Glass struct udevice *dev; 520d82ba4c0SSimon Glass int ret; 521d82ba4c0SSimon Glass 522d82ba4c0SSimon Glass *devp = NULL; 523d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 524d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 525d82ba4c0SSimon Glass } 526c275dfefSSimon Glass #endif 527d82ba4c0SSimon Glass 52854c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 5296494d708SSimon Glass { 53054c5d08aSHeiko Schocher struct udevice *dev; 5316494d708SSimon Glass int ret; 5326494d708SSimon Glass 5336494d708SSimon Glass *devp = NULL; 534c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 535f66529f9SSimon Glass if (!dev) 536f66529f9SSimon Glass return 0; 537c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5386494d708SSimon Glass } 5396494d708SSimon Glass 540b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 541b0675050SSimon Glass { 542b0675050SSimon Glass int ret; 543b0675050SSimon Glass 544b0675050SSimon Glass ret = uclass_first_device(id, devp); 545b0675050SSimon Glass if (ret) 546b0675050SSimon Glass return ret; 547b0675050SSimon Glass else if (!*devp) 548b0675050SSimon Glass return -ENODEV; 549b0675050SSimon Glass 550b0675050SSimon Glass return 0; 551b0675050SSimon Glass } 552b0675050SSimon Glass 55354c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 5546494d708SSimon Glass { 55554c5d08aSHeiko Schocher struct udevice *dev = *devp; 5566494d708SSimon Glass int ret; 5576494d708SSimon Glass 5586494d708SSimon Glass *devp = NULL; 559c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 560f66529f9SSimon Glass if (!dev) 561f66529f9SSimon Glass return 0; 562c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5636494d708SSimon Glass } 5646494d708SSimon Glass 565*f6abd538SPatrice Chotard int uclass_next_device_err(struct udevice **devp) 566*f6abd538SPatrice Chotard { 567*f6abd538SPatrice Chotard int ret; 568*f6abd538SPatrice Chotard 569*f6abd538SPatrice Chotard ret = uclass_next_device(devp); 570*f6abd538SPatrice Chotard if (ret) 571*f6abd538SPatrice Chotard return ret; 572*f6abd538SPatrice Chotard else if (!*devp) 573*f6abd538SPatrice Chotard return -ENODEV; 574*f6abd538SPatrice Chotard 575*f6abd538SPatrice Chotard return 0; 576*f6abd538SPatrice Chotard } 577*f6abd538SPatrice Chotard 57895ce385aSSimon Glass int uclass_first_device_check(enum uclass_id id, struct udevice **devp) 57995ce385aSSimon Glass { 58095ce385aSSimon Glass int ret; 58195ce385aSSimon Glass 58295ce385aSSimon Glass *devp = NULL; 58395ce385aSSimon Glass ret = uclass_find_first_device(id, devp); 58495ce385aSSimon Glass if (ret) 58595ce385aSSimon Glass return ret; 58695ce385aSSimon Glass if (!*devp) 58795ce385aSSimon Glass return 0; 58895ce385aSSimon Glass 58995ce385aSSimon Glass return device_probe(*devp); 59095ce385aSSimon Glass } 59195ce385aSSimon Glass 59295ce385aSSimon Glass int uclass_next_device_check(struct udevice **devp) 59395ce385aSSimon Glass { 59495ce385aSSimon Glass int ret; 59595ce385aSSimon Glass 59695ce385aSSimon Glass ret = uclass_find_next_device(devp); 59795ce385aSSimon Glass if (ret) 59895ce385aSSimon Glass return ret; 59995ce385aSSimon Glass if (!*devp) 60095ce385aSSimon Glass return 0; 60195ce385aSSimon Glass 60295ce385aSSimon Glass return device_probe(*devp); 60395ce385aSSimon Glass } 60495ce385aSSimon Glass 60554c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 6066494d708SSimon Glass { 6076494d708SSimon Glass struct uclass *uc; 6086494d708SSimon Glass int ret; 6096494d708SSimon Glass 6106494d708SSimon Glass uc = dev->uclass; 6116494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 6126494d708SSimon Glass 613081f2fcbSSimon Glass if (dev->parent) { 614081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 615081f2fcbSSimon Glass 616081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 617081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 618081f2fcbSSimon Glass if (ret) 619081f2fcbSSimon Glass goto err; 620081f2fcbSSimon Glass } 621081f2fcbSSimon Glass } 6226494d708SSimon Glass 6236494d708SSimon Glass return 0; 624081f2fcbSSimon Glass err: 625081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 626081f2fcbSSimon Glass list_del(&dev->uclass_node); 627081f2fcbSSimon Glass 628081f2fcbSSimon Glass return ret; 6296494d708SSimon Glass } 6306494d708SSimon Glass 6310a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 63254c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 6336494d708SSimon Glass { 6346494d708SSimon Glass struct uclass *uc; 6356494d708SSimon Glass int ret; 6366494d708SSimon Glass 6376494d708SSimon Glass uc = dev->uclass; 6386494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 6396494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 6406494d708SSimon Glass if (ret) 6416494d708SSimon Glass return ret; 6426494d708SSimon Glass } 6436494d708SSimon Glass 6446494d708SSimon Glass list_del(&dev->uclass_node); 6456494d708SSimon Glass return 0; 6466494d708SSimon Glass } 6477f9875e7SSimon Glass #endif 6486494d708SSimon Glass 6495a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 6505a66a8ffSSimon Glass { 6515a66a8ffSSimon Glass struct udevice *dup; 6525a66a8ffSSimon Glass int seq; 6535a66a8ffSSimon Glass int ret; 6545a66a8ffSSimon Glass 6555a66a8ffSSimon Glass assert(dev->seq == -1); 6565a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 6575a66a8ffSSimon Glass false, &dup); 6585a66a8ffSSimon Glass if (!ret) { 6595a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 6605a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 6615a66a8ffSSimon Glass } else if (ret == -ENODEV) { 6625a66a8ffSSimon Glass /* Our requested sequence number is available */ 6635a66a8ffSSimon Glass if (dev->req_seq != -1) 6645a66a8ffSSimon Glass return dev->req_seq; 6655a66a8ffSSimon Glass } else { 6665a66a8ffSSimon Glass return ret; 6675a66a8ffSSimon Glass } 6685a66a8ffSSimon Glass 6695a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 6705a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 6715a66a8ffSSimon Glass false, &dup); 6725a66a8ffSSimon Glass if (ret == -ENODEV) 6735a66a8ffSSimon Glass break; 6745a66a8ffSSimon Glass if (ret) 6755a66a8ffSSimon Glass return ret; 6765a66a8ffSSimon Glass } 6775a66a8ffSSimon Glass return seq; 6785a66a8ffSSimon Glass } 6795a66a8ffSSimon Glass 68002c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 68183c7e434SSimon Glass { 68283c7e434SSimon Glass struct uclass_driver *uc_drv; 68302c07b37SSimon Glass int ret; 68402c07b37SSimon Glass 68502c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 68602c07b37SSimon Glass if (uc_drv->pre_probe) { 68702c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 68802c07b37SSimon Glass if (ret) 68902c07b37SSimon Glass return ret; 69002c07b37SSimon Glass } 69183c7e434SSimon Glass 69283c7e434SSimon Glass if (!dev->parent) 69383c7e434SSimon Glass return 0; 69483c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 69583c7e434SSimon Glass if (uc_drv->child_pre_probe) 69683c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 69783c7e434SSimon Glass 69883c7e434SSimon Glass return 0; 69983c7e434SSimon Glass } 70083c7e434SSimon Glass 70154c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 7026494d708SSimon Glass { 703651d0c01SBin Meng struct uclass_driver *uc_drv; 704651d0c01SBin Meng int ret; 7056494d708SSimon Glass 706651d0c01SBin Meng if (dev->parent) { 707651d0c01SBin Meng uc_drv = dev->parent->uclass->uc_drv; 708651d0c01SBin Meng if (uc_drv->child_post_probe) { 709651d0c01SBin Meng ret = uc_drv->child_post_probe(dev); 710651d0c01SBin Meng if (ret) 711651d0c01SBin Meng return ret; 712651d0c01SBin Meng } 713651d0c01SBin Meng } 714651d0c01SBin Meng 715651d0c01SBin Meng uc_drv = dev->uclass->uc_drv; 7166494d708SSimon Glass if (uc_drv->post_probe) 7176494d708SSimon Glass return uc_drv->post_probe(dev); 7186494d708SSimon Glass 7196494d708SSimon Glass return 0; 7206494d708SSimon Glass } 7216494d708SSimon Glass 7220a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 72354c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 7246494d708SSimon Glass { 7256494d708SSimon Glass struct uclass *uc; 7266494d708SSimon Glass int ret; 7276494d708SSimon Glass 7286494d708SSimon Glass uc = dev->uclass; 7296494d708SSimon Glass if (uc->uc_drv->pre_remove) { 7306494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 7316494d708SSimon Glass if (ret) 7326494d708SSimon Glass return ret; 7336494d708SSimon Glass } 7346494d708SSimon Glass 7356494d708SSimon Glass return 0; 7366494d708SSimon Glass } 7377f9875e7SSimon Glass #endif 738