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 172