1*83d290c5STom 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 31140bb637dSSimon Glass *devp = NULL; 31240bb637dSSimon Glass if (!ofnode_valid(node)) 31340bb637dSSimon Glass return -ENODEV; 31440bb637dSSimon Glass ret = uclass_get(id, &uc); 31540bb637dSSimon Glass if (ret) 31640bb637dSSimon Glass return ret; 31740bb637dSSimon Glass 31840bb637dSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 31940bb637dSSimon Glass if (ofnode_equal(dev_ofnode(dev), node)) { 32040bb637dSSimon Glass *devp = dev; 32140bb637dSSimon Glass return 0; 32240bb637dSSimon Glass } 32340bb637dSSimon Glass } 32440bb637dSSimon Glass 32540bb637dSSimon Glass return -ENODEV; 32640bb637dSSimon Glass } 32740bb637dSSimon Glass 328c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 329d82ba4c0SSimon Glass static int uclass_find_device_by_phandle(enum uclass_id id, 330d82ba4c0SSimon Glass struct udevice *parent, 331d82ba4c0SSimon Glass const char *name, 332d82ba4c0SSimon Glass struct udevice **devp) 333d82ba4c0SSimon Glass { 334d82ba4c0SSimon Glass struct udevice *dev; 335d82ba4c0SSimon Glass struct uclass *uc; 336d82ba4c0SSimon Glass int find_phandle; 337d82ba4c0SSimon Glass int ret; 338d82ba4c0SSimon Glass 339d82ba4c0SSimon Glass *devp = NULL; 340a40cc8e1SSimon Glass find_phandle = dev_read_u32_default(parent, name, -1); 341d82ba4c0SSimon Glass if (find_phandle <= 0) 342d82ba4c0SSimon Glass return -ENOENT; 343d82ba4c0SSimon Glass ret = uclass_get(id, &uc); 344d82ba4c0SSimon Glass if (ret) 345d82ba4c0SSimon Glass return ret; 346d82ba4c0SSimon Glass 347d82ba4c0SSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 348e160f7d4SSimon Glass uint phandle; 349e160f7d4SSimon Glass 350a40cc8e1SSimon Glass phandle = dev_read_phandle(dev); 351d82ba4c0SSimon Glass 352d82ba4c0SSimon Glass if (phandle == find_phandle) { 353d82ba4c0SSimon Glass *devp = dev; 354d82ba4c0SSimon Glass return 0; 355d82ba4c0SSimon Glass } 356d82ba4c0SSimon Glass } 357d82ba4c0SSimon Glass 358d82ba4c0SSimon Glass return -ENODEV; 359d82ba4c0SSimon Glass } 360c275dfefSSimon Glass #endif 361d82ba4c0SSimon Glass 362c57f806bSSimon Glass int uclass_get_device_by_driver(enum uclass_id id, 363c57f806bSSimon Glass const struct driver *find_drv, 364c57f806bSSimon Glass struct udevice **devp) 365c57f806bSSimon Glass { 366c57f806bSSimon Glass struct udevice *dev; 367c57f806bSSimon Glass struct uclass *uc; 368c57f806bSSimon Glass int ret; 369c57f806bSSimon Glass 370c57f806bSSimon Glass ret = uclass_get(id, &uc); 371c57f806bSSimon Glass if (ret) 372c57f806bSSimon Glass return ret; 373c57f806bSSimon Glass 374c57f806bSSimon Glass list_for_each_entry(dev, &uc->dev_head, uclass_node) { 375c57f806bSSimon Glass if (dev->driver == find_drv) 376c57f806bSSimon Glass return uclass_get_device_tail(dev, 0, devp); 377c57f806bSSimon Glass } 378c57f806bSSimon Glass 379c57f806bSSimon Glass return -ENODEV; 380c57f806bSSimon Glass } 381c57f806bSSimon Glass 38230a570a9SSimon Glass int uclass_get_device_tail(struct udevice *dev, int ret, struct udevice **devp) 3836494d708SSimon Glass { 3846494d708SSimon Glass if (ret) 3856494d708SSimon Glass return ret; 3866494d708SSimon Glass 387f66529f9SSimon Glass assert(dev); 3886494d708SSimon Glass ret = device_probe(dev); 3896494d708SSimon Glass if (ret) 3906494d708SSimon Glass return ret; 3916494d708SSimon Glass 3926494d708SSimon Glass *devp = dev; 3936494d708SSimon Glass 3946494d708SSimon Glass return 0; 3956494d708SSimon Glass } 3966494d708SSimon Glass 3979ca296a1SSimon Glass int uclass_get_device(enum uclass_id id, int index, struct udevice **devp) 3989ca296a1SSimon Glass { 3999ca296a1SSimon Glass struct udevice *dev; 4009ca296a1SSimon Glass int ret; 4019ca296a1SSimon Glass 4029ca296a1SSimon Glass *devp = NULL; 4039ca296a1SSimon Glass ret = uclass_find_device(id, index, &dev); 4049ca296a1SSimon Glass return uclass_get_device_tail(dev, ret, devp); 4059ca296a1SSimon Glass } 4069ca296a1SSimon Glass 407b7af1a2dSPrzemyslaw Marczak int uclass_get_device_by_name(enum uclass_id id, const char *name, 408b7af1a2dSPrzemyslaw Marczak struct udevice **devp) 409b7af1a2dSPrzemyslaw Marczak { 410b7af1a2dSPrzemyslaw Marczak struct udevice *dev; 411b7af1a2dSPrzemyslaw Marczak int ret; 412b7af1a2dSPrzemyslaw Marczak 413b7af1a2dSPrzemyslaw Marczak *devp = NULL; 414b7af1a2dSPrzemyslaw Marczak ret = uclass_find_device_by_name(id, name, &dev); 415b7af1a2dSPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 416b7af1a2dSPrzemyslaw Marczak } 417b7af1a2dSPrzemyslaw Marczak 4185a66a8ffSSimon Glass int uclass_get_device_by_seq(enum uclass_id id, int seq, struct udevice **devp) 4195a66a8ffSSimon Glass { 4205a66a8ffSSimon Glass struct udevice *dev; 4215a66a8ffSSimon Glass int ret; 4225a66a8ffSSimon Glass 4235a66a8ffSSimon Glass *devp = NULL; 4245a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, false, &dev); 4255a66a8ffSSimon Glass if (ret == -ENODEV) { 4265a66a8ffSSimon Glass /* 4275a66a8ffSSimon Glass * We didn't find it in probed devices. See if there is one 4285a66a8ffSSimon Glass * that will request this seq if probed. 4295a66a8ffSSimon Glass */ 4305a66a8ffSSimon Glass ret = uclass_find_device_by_seq(id, seq, true, &dev); 4315a66a8ffSSimon Glass } 4325a66a8ffSSimon Glass return uclass_get_device_tail(dev, ret, devp); 4335a66a8ffSSimon Glass } 4345a66a8ffSSimon Glass 435f4cdead2SSimon Glass int uclass_get_device_by_of_offset(enum uclass_id id, int node, 436f4cdead2SSimon Glass struct udevice **devp) 437f4cdead2SSimon Glass { 438f4cdead2SSimon Glass struct udevice *dev; 439f4cdead2SSimon Glass int ret; 440f4cdead2SSimon Glass 441f4cdead2SSimon Glass *devp = NULL; 442f4cdead2SSimon Glass ret = uclass_find_device_by_of_offset(id, node, &dev); 443f4cdead2SSimon Glass return uclass_get_device_tail(dev, ret, devp); 444f4cdead2SSimon Glass } 445f4cdead2SSimon Glass 44640bb637dSSimon Glass int uclass_get_device_by_ofnode(enum uclass_id id, ofnode node, 44740bb637dSSimon Glass struct udevice **devp) 44840bb637dSSimon Glass { 44940bb637dSSimon Glass struct udevice *dev; 45040bb637dSSimon Glass int ret; 45140bb637dSSimon Glass 45240bb637dSSimon Glass *devp = NULL; 45340bb637dSSimon Glass ret = uclass_find_device_by_ofnode(id, node, &dev); 45440bb637dSSimon Glass 45540bb637dSSimon Glass return uclass_get_device_tail(dev, ret, devp); 45640bb637dSSimon Glass } 45740bb637dSSimon Glass 458c275dfefSSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) 459d255fadeSKever Yang int uclass_get_device_by_phandle_id(enum uclass_id id, uint phandle_id, 460d255fadeSKever Yang struct udevice **devp) 461d255fadeSKever Yang { 462d255fadeSKever Yang struct udevice *dev; 463d255fadeSKever Yang struct uclass *uc; 464d255fadeSKever Yang int ret; 465d255fadeSKever Yang 466d255fadeSKever Yang *devp = NULL; 467d255fadeSKever Yang ret = uclass_get(id, &uc); 468d255fadeSKever Yang if (ret) 469d255fadeSKever Yang return ret; 470d255fadeSKever Yang 471d255fadeSKever Yang list_for_each_entry(dev, &uc->dev_head, uclass_node) { 472d255fadeSKever Yang uint phandle; 473d255fadeSKever Yang 474d255fadeSKever Yang phandle = dev_read_phandle(dev); 475d255fadeSKever Yang 476d255fadeSKever Yang if (phandle == phandle_id) { 477d255fadeSKever Yang *devp = dev; 478d255fadeSKever Yang return uclass_get_device_tail(dev, ret, devp); 479d255fadeSKever Yang } 480d255fadeSKever Yang } 481d255fadeSKever Yang 482d255fadeSKever Yang return -ENODEV; 483d255fadeSKever Yang } 484d255fadeSKever Yang 485d82ba4c0SSimon Glass int uclass_get_device_by_phandle(enum uclass_id id, struct udevice *parent, 486d82ba4c0SSimon Glass const char *name, struct udevice **devp) 487d82ba4c0SSimon Glass { 488d82ba4c0SSimon Glass struct udevice *dev; 489d82ba4c0SSimon Glass int ret; 490d82ba4c0SSimon Glass 491d82ba4c0SSimon Glass *devp = NULL; 492d82ba4c0SSimon Glass ret = uclass_find_device_by_phandle(id, parent, name, &dev); 493d82ba4c0SSimon Glass return uclass_get_device_tail(dev, ret, devp); 494d82ba4c0SSimon Glass } 495c275dfefSSimon Glass #endif 496d82ba4c0SSimon Glass 49754c5d08aSHeiko Schocher int uclass_first_device(enum uclass_id id, struct udevice **devp) 4986494d708SSimon Glass { 49954c5d08aSHeiko Schocher struct udevice *dev; 5006494d708SSimon Glass int ret; 5016494d708SSimon Glass 5026494d708SSimon Glass *devp = NULL; 503c1d6f919SPrzemyslaw Marczak ret = uclass_find_first_device(id, &dev); 504f66529f9SSimon Glass if (!dev) 505f66529f9SSimon Glass return 0; 506c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5076494d708SSimon Glass } 5086494d708SSimon Glass 509b0675050SSimon Glass int uclass_first_device_err(enum uclass_id id, struct udevice **devp) 510b0675050SSimon Glass { 511b0675050SSimon Glass int ret; 512b0675050SSimon Glass 513b0675050SSimon Glass ret = uclass_first_device(id, devp); 514b0675050SSimon Glass if (ret) 515b0675050SSimon Glass return ret; 516b0675050SSimon Glass else if (!*devp) 517b0675050SSimon Glass return -ENODEV; 518b0675050SSimon Glass 519b0675050SSimon Glass return 0; 520b0675050SSimon Glass } 521b0675050SSimon Glass 52254c5d08aSHeiko Schocher int uclass_next_device(struct udevice **devp) 5236494d708SSimon Glass { 52454c5d08aSHeiko Schocher struct udevice *dev = *devp; 5256494d708SSimon Glass int ret; 5266494d708SSimon Glass 5276494d708SSimon Glass *devp = NULL; 528c1d6f919SPrzemyslaw Marczak ret = uclass_find_next_device(&dev); 529f66529f9SSimon Glass if (!dev) 530f66529f9SSimon Glass return 0; 531c1d6f919SPrzemyslaw Marczak return uclass_get_device_tail(dev, ret, devp); 5326494d708SSimon Glass } 5336494d708SSimon Glass 53495ce385aSSimon Glass int uclass_first_device_check(enum uclass_id id, struct udevice **devp) 53595ce385aSSimon Glass { 53695ce385aSSimon Glass int ret; 53795ce385aSSimon Glass 53895ce385aSSimon Glass *devp = NULL; 53995ce385aSSimon Glass ret = uclass_find_first_device(id, devp); 54095ce385aSSimon Glass if (ret) 54195ce385aSSimon Glass return ret; 54295ce385aSSimon Glass if (!*devp) 54395ce385aSSimon Glass return 0; 54495ce385aSSimon Glass 54595ce385aSSimon Glass return device_probe(*devp); 54695ce385aSSimon Glass } 54795ce385aSSimon Glass 54895ce385aSSimon Glass int uclass_next_device_check(struct udevice **devp) 54995ce385aSSimon Glass { 55095ce385aSSimon Glass int ret; 55195ce385aSSimon Glass 55295ce385aSSimon Glass ret = uclass_find_next_device(devp); 55395ce385aSSimon Glass if (ret) 55495ce385aSSimon Glass return ret; 55595ce385aSSimon Glass if (!*devp) 55695ce385aSSimon Glass return 0; 55795ce385aSSimon Glass 55895ce385aSSimon Glass return device_probe(*devp); 55995ce385aSSimon Glass } 56095ce385aSSimon Glass 56154c5d08aSHeiko Schocher int uclass_bind_device(struct udevice *dev) 5626494d708SSimon Glass { 5636494d708SSimon Glass struct uclass *uc; 5646494d708SSimon Glass int ret; 5656494d708SSimon Glass 5666494d708SSimon Glass uc = dev->uclass; 5676494d708SSimon Glass list_add_tail(&dev->uclass_node, &uc->dev_head); 5686494d708SSimon Glass 569081f2fcbSSimon Glass if (dev->parent) { 570081f2fcbSSimon Glass struct uclass_driver *uc_drv = dev->parent->uclass->uc_drv; 571081f2fcbSSimon Glass 572081f2fcbSSimon Glass if (uc_drv->child_post_bind) { 573081f2fcbSSimon Glass ret = uc_drv->child_post_bind(dev); 574081f2fcbSSimon Glass if (ret) 575081f2fcbSSimon Glass goto err; 576081f2fcbSSimon Glass } 577081f2fcbSSimon Glass } 5786494d708SSimon Glass 5796494d708SSimon Glass return 0; 580081f2fcbSSimon Glass err: 581081f2fcbSSimon Glass /* There is no need to undo the parent's post_bind call */ 582081f2fcbSSimon Glass list_del(&dev->uclass_node); 583081f2fcbSSimon Glass 584081f2fcbSSimon Glass return ret; 5856494d708SSimon Glass } 5866494d708SSimon Glass 5870a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 58854c5d08aSHeiko Schocher int uclass_unbind_device(struct udevice *dev) 5896494d708SSimon Glass { 5906494d708SSimon Glass struct uclass *uc; 5916494d708SSimon Glass int ret; 5926494d708SSimon Glass 5936494d708SSimon Glass uc = dev->uclass; 5946494d708SSimon Glass if (uc->uc_drv->pre_unbind) { 5956494d708SSimon Glass ret = uc->uc_drv->pre_unbind(dev); 5966494d708SSimon Glass if (ret) 5976494d708SSimon Glass return ret; 5986494d708SSimon Glass } 5996494d708SSimon Glass 6006494d708SSimon Glass list_del(&dev->uclass_node); 6016494d708SSimon Glass return 0; 6026494d708SSimon Glass } 6037f9875e7SSimon Glass #endif 6046494d708SSimon Glass 6055a66a8ffSSimon Glass int uclass_resolve_seq(struct udevice *dev) 6065a66a8ffSSimon Glass { 6075a66a8ffSSimon Glass struct udevice *dup; 6085a66a8ffSSimon Glass int seq; 6095a66a8ffSSimon Glass int ret; 6105a66a8ffSSimon Glass 6115a66a8ffSSimon Glass assert(dev->seq == -1); 6125a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, dev->req_seq, 6135a66a8ffSSimon Glass false, &dup); 6145a66a8ffSSimon Glass if (!ret) { 6155a66a8ffSSimon Glass dm_warn("Device '%s': seq %d is in use by '%s'\n", 6165a66a8ffSSimon Glass dev->name, dev->req_seq, dup->name); 6175a66a8ffSSimon Glass } else if (ret == -ENODEV) { 6185a66a8ffSSimon Glass /* Our requested sequence number is available */ 6195a66a8ffSSimon Glass if (dev->req_seq != -1) 6205a66a8ffSSimon Glass return dev->req_seq; 6215a66a8ffSSimon Glass } else { 6225a66a8ffSSimon Glass return ret; 6235a66a8ffSSimon Glass } 6245a66a8ffSSimon Glass 6255a66a8ffSSimon Glass for (seq = 0; seq < DM_MAX_SEQ; seq++) { 6265a66a8ffSSimon Glass ret = uclass_find_device_by_seq(dev->uclass->uc_drv->id, seq, 6275a66a8ffSSimon Glass false, &dup); 6285a66a8ffSSimon Glass if (ret == -ENODEV) 6295a66a8ffSSimon Glass break; 6305a66a8ffSSimon Glass if (ret) 6315a66a8ffSSimon Glass return ret; 6325a66a8ffSSimon Glass } 6335a66a8ffSSimon Glass return seq; 6345a66a8ffSSimon Glass } 6355a66a8ffSSimon Glass 63602c07b37SSimon Glass int uclass_pre_probe_device(struct udevice *dev) 63783c7e434SSimon Glass { 63883c7e434SSimon Glass struct uclass_driver *uc_drv; 63902c07b37SSimon Glass int ret; 64002c07b37SSimon Glass 64102c07b37SSimon Glass uc_drv = dev->uclass->uc_drv; 64202c07b37SSimon Glass if (uc_drv->pre_probe) { 64302c07b37SSimon Glass ret = uc_drv->pre_probe(dev); 64402c07b37SSimon Glass if (ret) 64502c07b37SSimon Glass return ret; 64602c07b37SSimon Glass } 64783c7e434SSimon Glass 64883c7e434SSimon Glass if (!dev->parent) 64983c7e434SSimon Glass return 0; 65083c7e434SSimon Glass uc_drv = dev->parent->uclass->uc_drv; 65183c7e434SSimon Glass if (uc_drv->child_pre_probe) 65283c7e434SSimon Glass return uc_drv->child_pre_probe(dev); 65383c7e434SSimon Glass 65483c7e434SSimon Glass return 0; 65583c7e434SSimon Glass } 65683c7e434SSimon Glass 65754c5d08aSHeiko Schocher int uclass_post_probe_device(struct udevice *dev) 6586494d708SSimon Glass { 6596494d708SSimon Glass struct uclass_driver *uc_drv = dev->uclass->uc_drv; 6606494d708SSimon Glass 6616494d708SSimon Glass if (uc_drv->post_probe) 6626494d708SSimon Glass return uc_drv->post_probe(dev); 6636494d708SSimon Glass 6646494d708SSimon Glass return 0; 6656494d708SSimon Glass } 6666494d708SSimon Glass 6670a5804b5SMasahiro Yamada #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE) 66854c5d08aSHeiko Schocher int uclass_pre_remove_device(struct udevice *dev) 6696494d708SSimon Glass { 6706494d708SSimon Glass struct uclass *uc; 6716494d708SSimon Glass int ret; 6726494d708SSimon Glass 6736494d708SSimon Glass uc = dev->uclass; 6746494d708SSimon Glass if (uc->uc_drv->pre_remove) { 6756494d708SSimon Glass ret = uc->uc_drv->pre_remove(dev); 6766494d708SSimon Glass if (ret) 6776494d708SSimon Glass return ret; 6786494d708SSimon Glass } 6796494d708SSimon Glass 6806494d708SSimon Glass return 0; 6816494d708SSimon Glass } 6827f9875e7SSimon Glass #endif 683