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 28 for (entry = drv; entry != drv + n_ents; entry++) { 29 if (!strcmp(name, entry->name)) 30 return entry; 31 } 32 33 /* Not found */ 34 return NULL; 35 } 36 37 struct uclass_driver *lists_uclass_lookup(enum uclass_id id) 38 { 39 struct uclass_driver *uclass = 40 ll_entry_start(struct uclass_driver, uclass); 41 const int n_ents = ll_entry_count(struct uclass_driver, uclass); 42 struct uclass_driver *entry; 43 44 for (entry = uclass; entry != uclass + n_ents; entry++) { 45 if (entry->id == id) 46 return entry; 47 } 48 49 return NULL; 50 } 51 52 int lists_bind_drivers(struct udevice *parent, bool pre_reloc_only) 53 { 54 struct driver_info *info = 55 ll_entry_start(struct driver_info, driver_info); 56 const int n_ents = ll_entry_count(struct driver_info, driver_info); 57 struct driver_info *entry; 58 struct udevice *dev; 59 int result = 0; 60 int ret; 61 62 for (entry = info; entry != info + n_ents; entry++) { 63 ret = device_bind_by_name(parent, pre_reloc_only, entry, &dev); 64 if (ret && ret != -EPERM) { 65 dm_warn("No match for driver '%s'\n", entry->name); 66 if (!result || ret != -ENOENT) 67 result = ret; 68 } 69 } 70 71 return result; 72 } 73 74 int device_bind_driver(struct udevice *parent, const char *drv_name, 75 const char *dev_name, struct udevice **devp) 76 { 77 return device_bind_driver_to_node(parent, drv_name, dev_name, 78 ofnode_null(), devp); 79 } 80 81 int device_bind_driver_to_node(struct udevice *parent, const char *drv_name, 82 const char *dev_name, ofnode node, 83 struct udevice **devp) 84 { 85 struct driver *drv; 86 int ret; 87 88 drv = lists_driver_lookup_name(drv_name); 89 if (!drv) { 90 debug("Cannot find driver '%s'\n", drv_name); 91 return -ENOENT; 92 } 93 ret = device_bind_with_driver_data(parent, drv, dev_name, 0 /* data */, 94 node, devp); 95 96 return ret; 97 } 98 99 #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA) 100 /** 101 * driver_check_compatible() - Check if a driver matches a compatible string 102 * 103 * @param of_match: List of compatible strings to match 104 * @param of_idp: Returns the match that was found 105 * @param compat: The compatible string to search for 106 * @return 0 if there is a match, -ENOENT if no match 107 */ 108 static int driver_check_compatible(const struct udevice_id *of_match, 109 const struct udevice_id **of_idp, 110 const char *compat) 111 { 112 if (!of_match) 113 return -ENOENT; 114 115 while (of_match->compatible) { 116 if (!strcmp(of_match->compatible, compat)) { 117 *of_idp = of_match; 118 return 0; 119 } 120 of_match++; 121 } 122 123 return -ENOENT; 124 } 125 126 int lists_bind_fdt(struct udevice *parent, ofnode node, struct udevice **devp) 127 { 128 struct driver *driver = ll_entry_start(struct driver, driver); 129 const int n_ents = ll_entry_count(struct driver, driver); 130 const struct udevice_id *id; 131 struct driver *entry; 132 struct udevice *dev; 133 bool found = false; 134 const char *name, *compat_list, *compat; 135 int compat_length, i; 136 int result = 0; 137 int ret = 0; 138 139 if (devp) 140 *devp = NULL; 141 name = ofnode_get_name(node); 142 pr_debug("bind node %s\n", name); 143 144 compat_list = ofnode_get_property(node, "compatible", &compat_length); 145 if (!compat_list) { 146 if (compat_length == -FDT_ERR_NOTFOUND) { 147 pr_debug("Device '%s' has no compatible string\n", 148 name); 149 return 0; 150 } 151 152 dm_warn("Device tree error at node '%s'\n", name); 153 return compat_length; 154 } 155 156 /* 157 * Walk through the compatible string list, attempting to match each 158 * compatible string in order such that we match in order of priority 159 * from the first string to the last. 160 */ 161 for (i = 0; i < compat_length; i += strlen(compat) + 1) { 162 compat = compat_list + i; 163 pr_debug(" - attempt to match compatible string '%s'\n", 164 compat); 165 166 for (entry = driver; entry != driver + n_ents; entry++) { 167 ret = driver_check_compatible(entry->of_match, &id, 168 compat); 169 if (!ret) 170 break; 171 } 172 if (entry == driver + n_ents) 173 continue; 174 175 pr_debug(" - found match at '%s'\n", entry->name); 176 ret = device_bind_with_driver_data(parent, entry, name, 177 id->data, node, &dev); 178 if (ret == -ENODEV) { 179 pr_debug("Driver '%s' refuses to bind\n", entry->name); 180 continue; 181 } 182 if (ret) { 183 dm_warn("Error binding driver '%s': %d\n", entry->name, 184 ret); 185 return ret; 186 } else { 187 found = true; 188 if (devp) 189 *devp = dev; 190 } 191 break; 192 } 193 194 if (!found && !result && ret != -ENODEV) 195 pr_debug("No match for node '%s'\n", name); 196 197 return result; 198 } 199 #endif 200