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 17454c5d08aSHeiko Schocher int uclass_find_device(enum uclass_id id, int index, struct udevice **devp) 1756494d708SSimon Glass { 1766494d708SSimon Glass struct uclass *uc; 17754c5d08aSHeiko Schocher struct udevice *dev; 1786494d708SSimon Glass int ret; 1796494d708SSimon Glass 1806494d708SSimon Glass *devp = NULL; 1816494d708SSimon Glass ret = uclass_get(id, &uc); 1826494d708SSimon Glass if (ret) 1836494d708SSimon Glass return ret; 1842fda14aeSSimon Glass if (list_empty(&uc->dev_head)) 1852fda14aeSSimon Glass return -ENODEV; 1866494d708SSimon Glass 1876494d708SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 1886494d708SSimon Glass if (!index--) { 1896494d708SSimon Glass *devp = dev; 1906494d708SSimon Glass return 0; 1916494d708SSimon Glass } 1926494d708SSimon Glass } 1936494d708SSimon Glass 1946494d708SSimon Glass return -ENODEV; 1956494d708SSimon Glass } 1966494d708SSimon Glass 197c1d6f919SPrzemyslaw Marczak int uclass_find_first_device(enum uclass_id id, struct udevice **devp) 198c1d6f919SPrzemyslaw Marczak { 199c1d6f919SPrzemyslaw Marczak struct uclass *uc; 200c1d6f919SPrzemyslaw Marczak int ret; 201c1d6f919SPrzemyslaw Marczak 202c1d6f919SPrzemyslaw Marczak *devp = NULL; 203c1d6f919SPrzemyslaw Marczak ret = uclass_get(id, &uc); 204c1d6f919SPrzemyslaw Marczak if (ret) 205c1d6f919SPrzemyslaw Marczak return ret; 206c1d6f919SPrzemyslaw Marczak if (list_empty(&uc->dev_head)) 207c1d6f919SPrzemyslaw Marczak return 0; 208c1d6f919SPrzemyslaw Marczak 209c1d6f919SPrzemyslaw Marczak *devp = list_first_entry(&uc->dev_head, struct udevice, uclass_node); 210c1d6f919SPrzemyslaw Marczak 211c1d6f919SPrzemyslaw Marczak return 0; 212c1d6f919SPrzemyslaw Marczak } 213c1d6f919SPrzemyslaw Marczak 214c1d6f919SPrzemyslaw Marczak int uclass_find_next_device(struct udevice **devp) 215c1d6f919SPrzemyslaw Marczak { 216c1d6f919SPrzemyslaw Marczak struct udevice *dev = *devp; 217c1d6f919SPrzemyslaw Marczak 218c1d6f919SPrzemyslaw Marczak *devp = NULL; 219c1d6f919SPrzemyslaw Marczak if (list_is_last(&dev->uclass_node, &dev->uclass->dev_head)) 220c1d6f919SPrzemyslaw Marczak return 0; 221c1d6f919SPrzemyslaw Marczak 222c1d6f919SPrzemyslaw Marczak *devp = list_entry(dev->uclass_node.next, struct udevice, uclass_node); 223c1d6f919SPrzemyslaw Marczak 224c1d6f919SPrzemyslaw Marczak return 0; 225c1d6f919SPrzemyslaw Marczak } 226c1d6f919SPrzemyslaw Marczak 227e0735a4cSPrzemyslaw Marczak int uclass_find_device_by_name(enum uclass_id id, const char *name, 228e0735a4cSPrzemyslaw Marczak struct udevice **devp) 229e0735a4cSPrzemyslaw Marczak { 230e0735a4cSPrzemyslaw Marczak struct uclass *uc; 231e0735a4cSPrzemyslaw Marczak struct udevice *dev; 232e0735a4cSPrzemyslaw Marczak int ret; 233e0735a4cSPrzemyslaw Marczak 234e0735a4cSPrzemyslaw Marczak *devp = NULL; 235e0735a4cSPrzemyslaw Marczak if (!name) 236e0735a4cSPrzemyslaw Marczak return -EINVAL; 237e0735a4cSPrzemyslaw Marczak ret = uclass_get(id, &uc); 238e0735a4cSPrzemyslaw Marczak if (ret) 239e0735a4cSPrzemyslaw Marczak return ret; 240e0735a4cSPrzemyslaw Marczak 241e0735a4cSPrzemyslaw Marczak list_for_each_entry(dev, &uc->dev_head, uclass_node) { 242e0735a4cSPrzemyslaw Marczak if (!strncmp(dev->name, name, strlen(name))) { 243e0735a4cSPrzemyslaw Marczak *devp = dev; 244e0735a4cSPrzemyslaw Marczak return 0; 245e0735a4cSPrzemyslaw Marczak } 246e0735a4cSPrzemyslaw Marczak } 247e0735a4cSPrzemyslaw Marczak 248e0735a4cSPrzemyslaw Marczak return -ENODEV; 249e0735a4cSPrzemyslaw Marczak } 250e0735a4cSPrzemyslaw Marczak 2515a66a8ffSSimon Glass int uclass_find_device_by_seq(enum uclass_id id, int seq_or_req_seq, 2525a66a8ffSSimon Glass bool find_req_seq, struct udevice **devp) 2535a66a8ffSSimon Glass { 2545a66a8ffSSimon Glass struct uclass *uc; 2555a66a8ffSSimon Glass struct udevice *dev; 2565a66a8ffSSimon Glass int ret; 2575a66a8ffSSimon Glass 2585a66a8ffSSimon Glass *devp = NULL; 2595a66a8ffSSimon Glass debug("%s: %d %d\n", __func__, find_req_seq, seq_or_req_seq); 2605a66a8ffSSimon Glass if (seq_or_req_seq == -1) 2615a66a8ffSSimon Glass return -ENODEV; 2625a66a8ffSSimon Glass ret = uclass_get(id, &uc); 2635a66a8ffSSimon Glass if (ret) 2645a66a8ffSSimon Glass return ret; 2655a66a8ffSSimon Glass 2665a66a8ffSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 267ea168e33SAlexandru Gagniuc debug(" - %d %d '%s'\n", dev->req_seq, dev->seq, dev->name); 2685a66a8ffSSimon Glass if ((find_req_seq ? dev->req_seq : dev->seq) == 2695a66a8ffSSimon Glass seq_or_req_seq) { 2705a66a8ffSSimon Glass *devp = dev; 2715a66a8ffSSimon Glass debug(" - found\n"); 2725a66a8ffSSimon Glass return 0; 2735a66a8ffSSimon Glass } 2745a66a8ffSSimon Glass } 2755a66a8ffSSimon Glass debug(" - not found\n"); 2765a66a8ffSSimon Glass 2775a66a8ffSSimon Glass return -ENODEV; 2785a66a8ffSSimon Glass } 2795a66a8ffSSimon Glass 2801b30d61dSSimon Glass int uclass_find_device_by_of_offset(enum uclass_id id, int node, 281f4cdead2SSimon Glass struct udevice **devp) 282f4cdead2SSimon Glass { 283f4cdead2SSimon Glass struct uclass *uc; 284f4cdead2SSimon Glass struct udevice *dev; 285f4cdead2SSimon Glass int ret; 286f4cdead2SSimon Glass 287f4cdead2SSimon Glass *devp = NULL; 288f4cdead2SSimon Glass if (node < 0) 289f4cdead2SSimon Glass return -ENODEV; 290f4cdead2SSimon Glass ret = uclass_get(id, &uc); 291f4cdead2SSimon Glass if (ret) 292f4cdead2SSimon Glass return ret; 293f4cdead2SSimon Glass 294f4cdead2SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 295e160f7d4SSimon Glass if (dev_of_offset(dev) == node) { 296f4cdead2SSimon Glass *devp = dev; 297f4cdead2SSimon Glass return 0; 298f4cdead2SSimon Glass } 299f4cdead2SSimon Glass } 300f4cdead2SSimon Glass 301f4cdead2SSimon Glass return -ENODEV; 302f4cdead2SSimon Glass } 303f4cdead2SSimon Glass 30440bb637dSSimon Glass int uclass_find_device_by_ofnode(enum uclass_id id, ofnode node, 30540bb637dSSimon Glass struct udevice **devp) 30640bb637dSSimon Glass { 30740bb637dSSimon Glass struct uclass *uc; 30840bb637dSSimon Glass struct udevice *dev; 30940bb637dSSimon Glass int ret; 31040bb637dSSimon Glass 311*31e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 31240bb637dSSimon Glass *devp = NULL; 31340bb637dSSimon Glass if (!ofnode_valid(node)) 31440bb637dSSimon Glass return -ENODEV; 31540bb637dSSimon Glass ret = uclass_get(id, &uc); 31640bb637dSSimon Glass if (ret) 31740bb637dSSimon Glass return ret; 31840bb637dSSimon Glass 31940bb637dSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 320*31e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG_CONTENT, " - checking %s\n", 321*31e60ffaSSimon Glass dev->name); 32240bb637dSSimon Glass if (ofnode_equal(dev_ofnode(dev), node)) { 32340bb637dSSimon Glass *devp = dev; 324*31e60ffaSSimon Glass goto done; 32540bb637dSSimon Glass } 32640bb637dSSimon Glass } 327*31e60ffaSSimon Glass ret = -ENODEV; 32840bb637dSSimon Glass 329*31e60ffaSSimon Glass done: 330*31e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 331*31e60ffaSSimon Glass ofnode_get_name(node), *devp ? (*devp)->name : "(none)", ret); 332*31e60ffaSSimon Glass return ret; 33340bb637dSSimon Glass } 33440bb637dSSimon Glass 335c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 336d82ba4c0SSimon Glass static int uclass_find_device_by_phandle(enum uclass_id id, 337d82ba4c0SSimon Glass struct udevice *parent, 338d82ba4c0SSimon Glass const char *name, 339d82ba4c0SSimon Glass struct udevice **devp) 340d82ba4c0SSimon Glass { 341d82ba4c0SSimon Glass struct udevice *dev; 342d82ba4c0SSimon Glass struct uclass *uc; 343d82ba4c0SSimon Glass int find_phandle; 344d82ba4c0SSimon Glass int ret; 345d82ba4c0SSimon Glass 346d82ba4c0SSimon Glass *devp = NULL; 347a40cc8e1SSimon Glass find_phandle = dev_read_u32_default(parent, name, -1); 348d82ba4c0SSimon Glass if (find_phandle <= 0) 349d82ba4c0SSimon Glass return -ENOENT; 350d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 351d82ba4c0SSimon Glass if (ret) 352d82ba4c0SSimon Glass return ret; 353d82ba4c0SSimon Glass 354d82ba4c0SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 355e160f7d4SSimon Glass uint phandle; 356e160f7d4SSimon Glass 357a40cc8e1SSimon Glass phandle = dev_read_phandle(dev); 358d82ba4c0SSimon Glass 359d82ba4c0SSimon Glass if (phandle == find_phandle) { 360d82ba4c0SSimon Glass *devp = dev; 361d82ba4c0SSimon Glass return 0; 362d82ba4c0SSimon Glass } 363d82ba4c0SSimon Glass } 364d82ba4c0SSimon Glass 365d82ba4c0SSimon Glass return -ENODEV; 366d82ba4c0SSimon Glass } 367c275dfefSSimon Glass #endif 368d82ba4c0SSimon Glass 369c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 370c57f806bSSimon Glass const struct driver *find_drv, 371c57f806bSSimon Glass struct udevice **devp) 372c57f806bSSimon Glass { 373c57f806bSSimon Glass struct udevice *dev; 374c57f806bSSimon Glass struct uclass *uc; 375c57f806bSSimon Glass int ret; 376c57f806bSSimon Glass 377c57f806bSSimon Glass ret = uclass_get(id, &uc); 378c57f806bSSimon Glass if (ret) 379c57f806bSSimon Glass return ret; 380c57f806bSSimon Glass 381c57f806bSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 382c57f806bSSimon Glass if (dev->driver == find_drv) 383c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 384c57f806bSSimon Glass } 385c57f806bSSimon Glass 386c57f806bSSimon Glass return -ENODEV; 387c57f806bSSimon Glass } 388c57f806bSSimon Glass 38930a570a9SSimon Glass int uclass_get_device_tail(struct udevice *dev, int ret, struct udevice **devp) 3906494d708SSimon Glass { 3916494d708SSimon Glass if (ret) 3926494d708SSimon Glass return ret; 3936494d708SSimon Glass 394f66529f9SSimon Glass assert(dev); 3956494d708SSimon Glass ret = device_probe(dev); 3966494d708SSimon Glass if (ret) 3976494d708SSimon Glass return ret; 3986494d708SSimon Glass 3996494d708SSimon Glass *devp = dev; 4006494d708SSimon Glass 4016494d708SSimon Glass return 0; 4026494d708SSimon Glass } 4036494d708SSimon Glass 4049ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 4059ca296a1SSimon Glass { 4069ca296a1SSimon Glass struct udevice *dev; 4079ca296a1SSimon Glass int ret; 4089ca296a1SSimon Glass 4099ca296a1SSimon Glass *devp = NULL; 4109ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 4119ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 4129ca296a1SSimon Glass } 4139ca296a1SSimon Glass 414b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 415b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 416b7af1a2dSPrzemyslaw Marczak { 417b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 418b7af1a2dSPrzemyslaw Marczak int ret; 419b7af1a2dSPrzemyslaw Marczak 420b7af1a2dSPrzemyslaw Marczak *devp = NULL; 421b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 422b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 423b7af1a2dSPrzemyslaw Marczak } 424b7af1a2dSPrzemyslaw Marczak 4255a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 4265a66a8ffSSimon Glass { 4275a66a8ffSSimon Glass struct udevice *dev; 4285a66a8ffSSimon Glass int ret; 4295a66a8ffSSimon Glass 4305a66a8ffSSimon Glass *devp = NULL; 4315a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 4325a66a8ffSSimon Glass if (ret == -ENODEV) { 4335a66a8ffSSimon Glass /* 4345a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 4355a66a8ffSSimon Glass * that will request this seq if probed. 4365a66a8ffSSimon Glass */ 4375a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 4385a66a8ffSSimon Glass } 4395a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 4405a66a8ffSSimon Glass } 4415a66a8ffSSimon Glass 442f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 443f4cdead2SSimon Glass struct udevice **devp) 444f4cdead2SSimon Glass { 445f4cdead2SSimon Glass struct udevice *dev; 446f4cdead2SSimon Glass int ret; 447f4cdead2SSimon Glass 448f4cdead2SSimon Glass *devp = NULL; 449f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 450f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 451f4cdead2SSimon Glass } 452f4cdead2SSimon Glass 45340bb637dSSimon Glass int uclass_get_device_by_ofnode(enum uclass_id id, ofnode node, 45440bb637dSSimon Glass struct udevice **devp) 45540bb637dSSimon Glass { 45640bb637dSSimon Glass struct udevice *dev; 45740bb637dSSimon Glass int ret; 45840bb637dSSimon Glass 459*31e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, "Looking for %s\n", ofnode_get_name(node)); 46040bb637dSSimon Glass *devp = NULL; 46140bb637dSSimon Glass ret = uclass_find_device_by_ofnode(id, node, &dev); 462*31e60ffaSSimon Glass log(LOGC_DM, LOGL_DEBUG, " - result for %s: %s (ret=%d)\n", 463*31e60ffaSSimon Glass ofnode_get_name(node), dev ? dev->name : "(none)", ret); 46440bb637dSSimon Glass 46540bb637dSSimon Glass return uclass_get_device_tail(dev, ret, devp); 46640bb637dSSimon Glass } 46740bb637dSSimon Glass 468c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 469d255fadeSKever Yang int uclass_get_device_by_phandle_id(enum uclass_id id, uint phandle_id, 470d255fadeSKever Yang struct udevice **devp) 471d255fadeSKever Yang { 472d255fadeSKever Yang struct udevice *dev; 473d255fadeSKever Yang struct uclass *uc; 474d255fadeSKever Yang int ret; 475d255fadeSKever Yang 476d255fadeSKever Yang *devp = NULL; 477d255fadeSKever Yang ret = uclass_get(id, &uc); 478d255fadeSKever Yang if (ret) 479d255fadeSKever Yang return ret; 480d255fadeSKever Yang 481d255fadeSKever Yang list_for_each_entry(dev, &uc->dev_head, uclass_node) { 482d255fadeSKever Yang uint phandle; 483d255fadeSKever Yang 484d255fadeSKever Yang phandle = dev_read_phandle(dev); 485d255fadeSKever Yang 486d255fadeSKever Yang if (phandle == phandle_id) { 487d255fadeSKever Yang *devp = dev; 488d255fadeSKever Yang return uclass_get_device_tail(dev, ret, devp); 489d255fadeSKever Yang } 490d255fadeSKever Yang } 491d255fadeSKever Yang 492d255fadeSKever Yang return -ENODEV; 493d255fadeSKever Yang } 494d255fadeSKever Yang 495d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 496d82ba4c0SSimon Glass const char *name, struct udevice **devp) 497d82ba4c0SSimon Glass { 498d82ba4c0SSimon Glass struct udevice *dev; 499d82ba4c0SSimon Glass int ret; 500d82ba4c0SSimon Glass 501d82ba4c0SSimon Glass *devp = NULL; 502d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 503d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 504d82ba4c0SSimon Glass } 505c275dfefSSimon Glass #endif 506d82ba4c0SSimon Glass 50754c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 5086494d708SSimon Glass { 50954c5d08aSHeiko Schocher struct udevice *dev; 5106494d708SSimon Glass int ret; 5116494d708SSimon Glass 5126494d708SSimon Glass *devp = NULL; 513c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 514f66529f9SSimon Glass if (!dev) 515f66529f9SSimon Glass return 0; 516c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5176494d708SSimon Glass } 5186494d708SSimon Glass 519b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 520b0675050SSimon Glass { 521b0675050SSimon Glass int ret; 522b0675050SSimon Glass 523b0675050SSimon Glass ret = uclass_first_device(id, devp); 524b0675050SSimon Glass if (ret) 525b0675050SSimon Glass return ret; 526b0675050SSimon Glass else if (!*devp) 527b0675050SSimon Glass return -ENODEV; 528b0675050SSimon Glass 529b0675050SSimon Glass return 0; 530b0675050SSimon Glass } 531b0675050SSimon Glass 53254c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 5336494d708SSimon Glass { 53454c5d08aSHeiko Schocher struct udevice *dev = *devp; 5356494d708SSimon Glass int ret; 5366494d708SSimon Glass 5376494d708SSimon Glass *devp = NULL; 538c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 539f66529f9SSimon Glass if (!dev) 540f66529f9SSimon Glass return 0; 541c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5426494d708SSimon Glass } 5436494d708SSimon Glass 54495ce385aSSimon Glass int uclass_first_device_check(enum uclass_id id, struct udevice **devp) 54595ce385aSSimon Glass { 54695ce385aSSimon Glass int ret; 54795ce385aSSimon Glass 54895ce385aSSimon Glass *devp = NULL; 54995ce385aSSimon Glass ret = uclass_find_first_device(id, devp); 55095ce385aSSimon Glass if (ret) 55195ce385aSSimon Glass return ret; 55295ce385aSSimon Glass if (!*devp) 55395ce385aSSimon Glass return 0; 55495ce385aSSimon Glass 55595ce385aSSimon Glass return device_probe(*devp); 55695ce385aSSimon Glass } 55795ce385aSSimon Glass 55895ce385aSSimon Glass int uclass_next_device_check(struct udevice **devp) 55995ce385aSSimon Glass { 56095ce385aSSimon Glass int ret; 56195ce385aSSimon Glass 56295ce385aSSimon Glass ret = uclass_find_next_device(devp); 56395ce385aSSimon Glass if (ret) 56495ce385aSSimon Glass return ret; 56595ce385aSSimon Glass if (!*devp) 56695ce385aSSimon Glass return 0; 56795ce385aSSimon Glass 56895ce385aSSimon Glass return device_probe(*devp); 56995ce385aSSimon Glass } 57095ce385aSSimon Glass 57154c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 5726494d708SSimon Glass { 5736494d708SSimon Glass struct uclass *uc; 5746494d708SSimon Glass int ret; 5756494d708SSimon Glass 5766494d708SSimon Glass uc = dev->uclass; 5776494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 5786494d708SSimon Glass 579081f2fcbSSimon Glass if (dev->parent) { 580081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 581081f2fcbSSimon Glass 582081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 583081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 584081f2fcbSSimon Glass if (ret) 585081f2fcbSSimon Glass goto err; 586081f2fcbSSimon Glass } 587081f2fcbSSimon Glass } 5886494d708SSimon Glass 5896494d708SSimon Glass return 0; 590081f2fcbSSimon Glass err: 591081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 592081f2fcbSSimon Glass list_del(&dev->uclass_node); 593081f2fcbSSimon Glass 594081f2fcbSSimon Glass return ret; 5956494d708SSimon Glass } 5966494d708SSimon Glass 5970a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 59854c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 5996494d708SSimon Glass { 6006494d708SSimon Glass struct uclass *uc; 6016494d708SSimon Glass int ret; 6026494d708SSimon Glass 6036494d708SSimon Glass uc = dev->uclass; 6046494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 6056494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 6066494d708SSimon Glass if (ret) 6076494d708SSimon Glass return ret; 6086494d708SSimon Glass } 6096494d708SSimon Glass 6106494d708SSimon Glass list_del(&dev->uclass_node); 6116494d708SSimon Glass return 0; 6126494d708SSimon Glass } 6137f9875e7SSimon Glass #endif 6146494d708SSimon Glass 6155a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 6165a66a8ffSSimon Glass { 6175a66a8ffSSimon Glass struct udevice *dup; 6185a66a8ffSSimon Glass int seq; 6195a66a8ffSSimon Glass int ret; 6205a66a8ffSSimon Glass 6215a66a8ffSSimon Glass assert(dev->seq == -1); 6225a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 6235a66a8ffSSimon Glass false, &dup); 6245a66a8ffSSimon Glass if (!ret) { 6255a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 6265a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 6275a66a8ffSSimon Glass } else if (ret == -ENODEV) { 6285a66a8ffSSimon Glass /* Our requested sequence number is available */ 6295a66a8ffSSimon Glass if (dev->req_seq != -1) 6305a66a8ffSSimon Glass return dev->req_seq; 6315a66a8ffSSimon Glass } else { 6325a66a8ffSSimon Glass return ret; 6335a66a8ffSSimon Glass } 6345a66a8ffSSimon Glass 6355a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 6365a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 6375a66a8ffSSimon Glass false, &dup); 6385a66a8ffSSimon Glass if (ret == -ENODEV) 6395a66a8ffSSimon Glass break; 6405a66a8ffSSimon Glass if (ret) 6415a66a8ffSSimon Glass return ret; 6425a66a8ffSSimon Glass } 6435a66a8ffSSimon Glass return seq; 6445a66a8ffSSimon Glass } 6455a66a8ffSSimon Glass 64602c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 64783c7e434SSimon Glass { 64883c7e434SSimon Glass struct uclass_driver *uc_drv; 64902c07b37SSimon Glass int ret; 65002c07b37SSimon Glass 65102c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 65202c07b37SSimon Glass if (uc_drv->pre_probe) { 65302c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 65402c07b37SSimon Glass if (ret) 65502c07b37SSimon Glass return ret; 65602c07b37SSimon Glass } 65783c7e434SSimon Glass 65883c7e434SSimon Glass if (!dev->parent) 65983c7e434SSimon Glass return 0; 66083c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 66183c7e434SSimon Glass if (uc_drv->child_pre_probe) 66283c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 66383c7e434SSimon Glass 66483c7e434SSimon Glass return 0; 66583c7e434SSimon Glass } 66683c7e434SSimon Glass 66754c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 6686494d708SSimon Glass { 6696494d708SSimon Glass struct uclass_driver *uc_drv = dev->uclass->uc_drv; 6706494d708SSimon Glass 6716494d708SSimon Glass if (uc_drv->post_probe) 6726494d708SSimon Glass return uc_drv->post_probe(dev); 6736494d708SSimon Glass 6746494d708SSimon Glass return 0; 6756494d708SSimon Glass } 6766494d708SSimon Glass 6770a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 67854c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 6796494d708SSimon Glass { 6806494d708SSimon Glass struct uclass *uc; 6816494d708SSimon Glass int ret; 6826494d708SSimon Glass 6836494d708SSimon Glass uc = dev->uclass; 6846494d708SSimon Glass if (uc->uc_drv->pre_remove) { 6856494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 6866494d708SSimon Glass if (ret) 6876494d708SSimon Glass return ret; 6886494d708SSimon Glass } 6896494d708SSimon Glass 6906494d708SSimon Glass return 0; 6916494d708SSimon Glass } 6927f9875e7SSimon Glass #endif 693