dm: Adjust lists_bind_fdt() to return the bound device
[karo-tx-uboot.git] / drivers / core / lists.c
1 /*
2  * Copyright (c) 2013 Google, Inc
3  *
4  * (C) Copyright 2012
5  * Marek Vasut <marex@denx.de>
6  *
7  * SPDX-License-Identifier:     GPL-2.0+
8  */
9
10 #include <common.h>
11 #include <errno.h>
12 #include <dm/device.h>
13 #include <dm/device-internal.h>
14 #include <dm/lists.h>
15 #include <dm/platdata.h>
16 #include <dm/uclass.h>
17 #include <dm/util.h>
18 #include <fdtdec.h>
19 #include <linux/compiler.h>
20
21 struct driver *lists_driver_lookup_name(const char *name)
22 {
23         struct driver *drv =
24                 ll_entry_start(struct driver, driver);
25         const int n_ents = ll_entry_count(struct driver, driver);
26         struct driver *entry;
27         int len;
28
29         if (!drv || !n_ents)
30                 return NULL;
31
32         len = strlen(name);
33
34         for (entry = drv; entry != drv + n_ents; entry++) {
35                 if (strncmp(name, entry->name, len))
36                         continue;
37
38                 /* Full match */
39                 if (len == strlen(entry->name))
40                         return entry;
41         }
42
43         /* Not found */
44         return NULL;
45 }
46
47 struct uclass_driver *lists_uclass_lookup(enum uclass_id id)
48 {
49         struct uclass_driver *uclass =
50                 ll_entry_start(struct uclass_driver, uclass);
51         const int n_ents = ll_entry_count(struct uclass_driver, uclass);
52         struct uclass_driver *entry;
53
54         if ((id == UCLASS_INVALID) || !uclass)
55                 return NULL;
56
57         for (entry = uclass; entry != uclass + n_ents; entry++) {
58                 if (entry->id == id)
59                         return entry;
60         }
61
62         return NULL;
63 }
64
65 int lists_bind_drivers(struct udevice *parent, bool pre_reloc_only)
66 {
67         struct driver_info *info =
68                 ll_entry_start(struct driver_info, driver_info);
69         const int n_ents = ll_entry_count(struct driver_info, driver_info);
70         struct driver_info *entry;
71         struct udevice *dev;
72         int result = 0;
73         int ret;
74
75         for (entry = info; entry != info + n_ents; entry++) {
76                 ret = device_bind_by_name(parent, pre_reloc_only, entry, &dev);
77                 if (ret && ret != -EPERM) {
78                         dm_warn("No match for driver '%s'\n", entry->name);
79                         if (!result || ret != -ENOENT)
80                                 result = ret;
81                 }
82         }
83
84         return result;
85 }
86
87 #ifdef CONFIG_OF_CONTROL
88 /**
89  * driver_check_compatible() - Check if a driver is compatible with this node
90  *
91  * @param blob:         Device tree pointer
92  * @param offset:       Offset of node in device tree
93  * @param of_matchL     List of compatible strings to match
94  * @return 0 if there is a match, -ENOENT if no match, -ENODEV if the node
95  * does not have a compatible string, other error <0 if there is a device
96  * tree error
97  */
98 static int driver_check_compatible(const void *blob, int offset,
99                                    const struct udevice_id *of_match)
100 {
101         int ret;
102
103         if (!of_match)
104                 return -ENOENT;
105
106         while (of_match->compatible) {
107                 ret = fdt_node_check_compatible(blob, offset,
108                                                 of_match->compatible);
109                 if (!ret)
110                         return 0;
111                 else if (ret == -FDT_ERR_NOTFOUND)
112                         return -ENODEV;
113                 else if (ret < 0)
114                         return -EINVAL;
115                 of_match++;
116         }
117
118         return -ENOENT;
119 }
120
121 int lists_bind_fdt(struct udevice *parent, const void *blob, int offset,
122                    struct udevice **devp)
123 {
124         struct driver *driver = ll_entry_start(struct driver, driver);
125         const int n_ents = ll_entry_count(struct driver, driver);
126         struct driver *entry;
127         struct udevice *dev;
128         bool found = false;
129         const char *name;
130         int result = 0;
131         int ret = 0;
132
133         dm_dbg("bind node %s\n", fdt_get_name(blob, offset, NULL));
134         if (devp)
135                 *devp = NULL;
136         for (entry = driver; entry != driver + n_ents; entry++) {
137                 ret = driver_check_compatible(blob, offset, entry->of_match);
138                 name = fdt_get_name(blob, offset, NULL);
139                 if (ret == -ENOENT) {
140                         continue;
141                 } else if (ret == -ENODEV) {
142                         dm_dbg("Device '%s' has no compatible string\n", name);
143                         break;
144                 } else if (ret) {
145                         dm_warn("Device tree error at offset %d\n", offset);
146                         if (!result || ret != -ENOENT)
147                                 result = ret;
148                         break;
149                 }
150
151                 dm_dbg("   - found match at '%s'\n", entry->name);
152                 ret = device_bind(parent, entry, name, NULL, offset, &dev);
153                 if (ret) {
154                         dm_warn("Error binding driver '%s'\n", entry->name);
155                         return ret;
156                 } else {
157                         found = true;
158                         if (devp)
159                                 *devp = dev;
160                 }
161                 break;
162         }
163
164         if (!found && !result && ret != -ENODEV) {
165                 dm_dbg("No match for node '%s'\n",
166                        fdt_get_name(blob, offset, NULL));
167         }
168
169         return result;
170 }
171 #endif