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 * Marek Vasut <marex@denx.de>
76494d708SSimon Glass */
86494d708SSimon Glass
96494d708SSimon Glass #include <common.h>
106494d708SSimon Glass #include <errno.h>
116494d708SSimon Glass #include <dm/device.h>
126494d708SSimon Glass #include <dm/device-internal.h>
13fd536d81SJeroen Hofstee #include <dm/lists.h>
146494d708SSimon Glass #include <dm/platdata.h>
156494d708SSimon Glass #include <dm/uclass.h>
166494d708SSimon Glass #include <dm/util.h>
176a6d8fbeSSimon Glass #include <fdtdec.h>
186494d708SSimon Glass #include <linux/compiler.h>
196494d708SSimon Glass
lists_driver_lookup_name(const char * name)206494d708SSimon Glass struct driver *lists_driver_lookup_name(const char *name)
216494d708SSimon Glass {
226494d708SSimon Glass struct driver *drv =
236494d708SSimon Glass ll_entry_start(struct driver, driver);
246494d708SSimon Glass const int n_ents = ll_entry_count(struct driver, driver);
256494d708SSimon Glass struct driver *entry;
266494d708SSimon Glass
276494d708SSimon Glass for (entry = drv; entry != drv + n_ents; entry++) {
282cede453SMasahiro Yamada if (!strcmp(name, entry->name))
296494d708SSimon Glass return entry;
306494d708SSimon Glass }
316494d708SSimon Glass
326494d708SSimon Glass /* Not found */
336494d708SSimon Glass return NULL;
346494d708SSimon Glass }
356494d708SSimon Glass
lists_uclass_lookup(enum uclass_id id)366494d708SSimon Glass struct uclass_driver *lists_uclass_lookup(enum uclass_id id)
376494d708SSimon Glass {
386494d708SSimon Glass struct uclass_driver *uclass =
396494d708SSimon Glass ll_entry_start(struct uclass_driver, uclass);
406494d708SSimon Glass const int n_ents = ll_entry_count(struct uclass_driver, uclass);
416494d708SSimon Glass struct uclass_driver *entry;
426494d708SSimon Glass
436494d708SSimon Glass for (entry = uclass; entry != uclass + n_ents; entry++) {
446494d708SSimon Glass if (entry->id == id)
456494d708SSimon Glass return entry;
466494d708SSimon Glass }
476494d708SSimon Glass
486494d708SSimon Glass return NULL;
496494d708SSimon Glass }
506494d708SSimon Glass
lists_bind_drivers(struct udevice * parent,bool pre_reloc_only)5100606d7eSSimon Glass int lists_bind_drivers(struct udevice *parent, bool pre_reloc_only)
526494d708SSimon Glass {
536494d708SSimon Glass struct driver_info *info =
546494d708SSimon Glass ll_entry_start(struct driver_info, driver_info);
556494d708SSimon Glass const int n_ents = ll_entry_count(struct driver_info, driver_info);
566494d708SSimon Glass struct driver_info *entry;
5754c5d08aSHeiko Schocher struct udevice *dev;
586494d708SSimon Glass int result = 0;
596494d708SSimon Glass int ret;
606494d708SSimon Glass
616494d708SSimon Glass for (entry = info; entry != info + n_ents; entry++) {
6200606d7eSSimon Glass ret = device_bind_by_name(parent, pre_reloc_only, entry, &dev);
6300606d7eSSimon Glass if (ret && ret != -EPERM) {
646494d708SSimon Glass dm_warn("No match for driver '%s'\n", entry->name);
656494d708SSimon Glass if (!result || ret != -ENOENT)
666494d708SSimon Glass result = ret;
676494d708SSimon Glass }
686494d708SSimon Glass }
696494d708SSimon Glass
706494d708SSimon Glass return result;
716494d708SSimon Glass }
726494d708SSimon Glass
device_bind_driver(struct udevice * parent,const char * drv_name,const char * dev_name,struct udevice ** devp)73e33dc221SSimon Glass int device_bind_driver(struct udevice *parent, const char *drv_name,
74e33dc221SSimon Glass const char *dev_name, struct udevice **devp)
75e33dc221SSimon Glass {
7645a26867SSimon Glass return device_bind_driver_to_node(parent, drv_name, dev_name,
7745a26867SSimon Glass ofnode_null(), devp);
785b9000ddSSimon Glass }
795b9000ddSSimon Glass
device_bind_driver_to_node(struct udevice * parent,const char * drv_name,const char * dev_name,ofnode node,struct udevice ** devp)805b9000ddSSimon Glass int device_bind_driver_to_node(struct udevice *parent, const char *drv_name,
8145a26867SSimon Glass const char *dev_name, ofnode node,
825b9000ddSSimon Glass struct udevice **devp)
835b9000ddSSimon Glass {
84e33dc221SSimon Glass struct driver *drv;
85e33dc221SSimon Glass int ret;
86e33dc221SSimon Glass
87e33dc221SSimon Glass drv = lists_driver_lookup_name(drv_name);
88e33dc221SSimon Glass if (!drv) {
893039811eSSimon Glass debug("Cannot find driver '%s'\n", drv_name);
90e33dc221SSimon Glass return -ENOENT;
91e33dc221SSimon Glass }
9245a26867SSimon Glass ret = device_bind_with_driver_data(parent, drv, dev_name, 0 /* data */,
9345a26867SSimon Glass node, devp);
94e33dc221SSimon Glass
9545a26867SSimon Glass return ret;
96e33dc221SSimon Glass }
97e33dc221SSimon Glass
9829629eb8SSimon Glass #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
996494d708SSimon Glass /**
100ce701721SPaul Burton * driver_check_compatible() - Check if a driver matches a compatible string
1016494d708SSimon Glass *
1022ef249b4SSimon Glass * @param of_match: List of compatible strings to match
1032ef249b4SSimon Glass * @param of_idp: Returns the match that was found
104ce701721SPaul Burton * @param compat: The compatible string to search for
105ce701721SPaul Burton * @return 0 if there is a match, -ENOENT if no match
1066494d708SSimon Glass */
driver_check_compatible(const struct udevice_id * of_match,const struct udevice_id ** of_idp,const char * compat)107ce701721SPaul Burton static int driver_check_compatible(const struct udevice_id *of_match,
108ce701721SPaul Burton const struct udevice_id **of_idp,
109ce701721SPaul Burton const char *compat)
1106494d708SSimon Glass {
1116494d708SSimon Glass if (!of_match)
1126494d708SSimon Glass return -ENOENT;
1136494d708SSimon Glass
1146494d708SSimon Glass while (of_match->compatible) {
115ce701721SPaul Burton if (!strcmp(of_match->compatible, compat)) {
1162ef249b4SSimon Glass *of_idp = of_match;
1176494d708SSimon Glass return 0;
1182ef249b4SSimon Glass }
1196494d708SSimon Glass of_match++;
1206494d708SSimon Glass }
1216494d708SSimon Glass
1226494d708SSimon Glass return -ENOENT;
1236494d708SSimon Glass }
1246494d708SSimon Glass
lists_bind_fdt(struct udevice * parent,ofnode node,struct udevice ** devp,bool pre_reloc_only)125*8d773c4aSBin Meng int lists_bind_fdt(struct udevice *parent, ofnode node, struct udevice **devp,
126*8d773c4aSBin Meng bool pre_reloc_only)
1276494d708SSimon Glass {
1286494d708SSimon Glass struct driver *driver = ll_entry_start(struct driver, driver);
1296494d708SSimon Glass const int n_ents = ll_entry_count(struct driver, driver);
1302ef249b4SSimon Glass const struct udevice_id *id;
1316494d708SSimon Glass struct driver *entry;
13254c5d08aSHeiko Schocher struct udevice *dev;
1339b0ba067SSimon Glass bool found = false;
134ce701721SPaul Burton const char *name, *compat_list, *compat;
135ce701721SPaul Burton int compat_length, i;
1366494d708SSimon Glass int result = 0;
1379b0ba067SSimon Glass int ret = 0;
1386494d708SSimon Glass
1391f359e36SSimon Glass if (devp)
1401f359e36SSimon Glass *devp = NULL;
141f5b5719cSSimon Glass name = ofnode_get_name(node);
142ceb91909SMasahiro Yamada pr_debug("bind node %s\n", name);
143ce701721SPaul Burton
14461e51babSMasahiro Yamada compat_list = ofnode_get_property(node, "compatible", &compat_length);
145ce701721SPaul Burton if (!compat_list) {
146ce701721SPaul Burton if (compat_length == -FDT_ERR_NOTFOUND) {
147ceb91909SMasahiro Yamada pr_debug("Device '%s' has no compatible string\n",
148ceb91909SMasahiro Yamada name);
149ce701721SPaul Burton return 0;
150ce701721SPaul Burton }
151ce701721SPaul Burton
152f5b5719cSSimon Glass dm_warn("Device tree error at node '%s'\n", name);
153ce701721SPaul Burton return compat_length;
154ce701721SPaul Burton }
155ce701721SPaul Burton
156ce701721SPaul Burton /*
157ce701721SPaul Burton * Walk through the compatible string list, attempting to match each
158ce701721SPaul Burton * compatible string in order such that we match in order of priority
159ce701721SPaul Burton * from the first string to the last.
160ce701721SPaul Burton */
161ce701721SPaul Burton for (i = 0; i < compat_length; i += strlen(compat) + 1) {
162ce701721SPaul Burton compat = compat_list + i;
163ceb91909SMasahiro Yamada pr_debug(" - attempt to match compatible string '%s'\n",
164ce701721SPaul Burton compat);
165ce701721SPaul Burton
166ce701721SPaul Burton for (entry = driver; entry != driver + n_ents; entry++) {
167ce701721SPaul Burton ret = driver_check_compatible(entry->of_match, &id,
168ce701721SPaul Burton compat);
169ce701721SPaul Burton if (!ret)
1706494d708SSimon Glass break;
1716494d708SSimon Glass }
172ce701721SPaul Burton if (entry == driver + n_ents)
173ce701721SPaul Burton continue;
1746494d708SSimon Glass
175*8d773c4aSBin Meng if (pre_reloc_only) {
176*8d773c4aSBin Meng if (!dm_ofnode_pre_reloc(node) &&
177*8d773c4aSBin Meng !(entry->flags & DM_FLAG_PRE_RELOC))
178*8d773c4aSBin Meng return 0;
179*8d773c4aSBin Meng }
180*8d773c4aSBin Meng
181ceb91909SMasahiro Yamada pr_debug(" - found match at '%s'\n", entry->name);
182daac3bfeSStephen Warren ret = device_bind_with_driver_data(parent, entry, name,
183f5b5719cSSimon Glass id->data, node, &dev);
1849fdfadf8SStephen Warren if (ret == -ENODEV) {
185ceb91909SMasahiro Yamada pr_debug("Driver '%s' refuses to bind\n", entry->name);
1869fdfadf8SStephen Warren continue;
1879fdfadf8SStephen Warren }
1886494d708SSimon Glass if (ret) {
189d062482bSSimon Glass dm_warn("Error binding driver '%s': %d\n", entry->name,
190d062482bSSimon Glass ret);
1911f359e36SSimon Glass return ret;
1929b0ba067SSimon Glass } else {
1939b0ba067SSimon Glass found = true;
1941f359e36SSimon Glass if (devp)
1951f359e36SSimon Glass *devp = dev;
1966494d708SSimon Glass }
1979b0ba067SSimon Glass break;
1989b0ba067SSimon Glass }
1999b0ba067SSimon Glass
200ce701721SPaul Burton if (!found && !result && ret != -ENODEV)
201ceb91909SMasahiro Yamada pr_debug("No match for node '%s'\n", name);
2026494d708SSimon Glass
2036494d708SSimon Glass return result;
2046494d708SSimon Glass }
2056494d708SSimon Glass #endif
206