drivers/core/lists.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 2013 Google, Inc
   4  *
   5  * (C) Copyright 2012
   6  * Marek Vasut <marex@denx.de>
   7  */
   8
   9 #define LOG_CATEGORY LOGC_DM
  10
  11 #include <common.h>
  12 #include <errno.h>
  13 #include <log.h>
  14 #include <dm/device.h>
  15 #include <dm/device-internal.h>
  16 #include <dm/lists.h>
  17 #include <dm/platdata.h>
  18 #include <dm/uclass.h>
  19 #include <dm/util.h>
  20 #include <fdtdec.h>
  21 #include <linux/compiler.h>
  22
  23 struct driver *lists_driver_lookup_name(const char *name)
  24 {
  25         struct driver *drv =
  26                 ll_entry_start(struct driver, driver);
  27         const int n_ents = ll_entry_count(struct driver, driver);
  28         struct driver *entry;
  29
  30         for (entry = drv; entry != drv + n_ents; entry++) {
  31                 if (!strcmp(name, entry->name))
  32                         return entry;
  33         }
  34
  35         /* Not found */
  36         return NULL;
  37 }
  38
  39 struct uclass_driver *lists_uclass_lookup(enum uclass_id id)
  40 {
  41         struct uclass_driver *uclass =
  42                 ll_entry_start(struct uclass_driver, uclass_driver);
  43         const int n_ents = ll_entry_count(struct uclass_driver, uclass_driver);
  44         struct uclass_driver *entry;
  45
  46         for (entry = uclass; entry != uclass + n_ents; entry++) {
  47                 if (entry->id == id)
  48                         return entry;
  49         }
  50
  51         return NULL;
  52 }
  53
  54 static int bind_drivers_pass(struct udevice *parent, bool pre_reloc_only)
  55 {
  56         struct driver_info *info =
  57                 ll_entry_start(struct driver_info, driver_info);
  58         const int n_ents = ll_entry_count(struct driver_info, driver_info);
  59         bool missing_parent = false;
  60         int result = 0;
  61         uint idx;
  62
  63         /*
  64          * Do one iteration through the driver_info records. For of-platdata,
  65          * bind only devices whose parent is already bound. If we find any
  66          * device we can't bind, set missing_parent to true, which will cause
  67          * this function to be called again.
  68          */
  69         for (idx = 0; idx < n_ents; idx++) {
  70                 struct udevice *par = parent;
  71                 const struct driver_info *entry = info + idx;
  72                 struct driver_rt *drt = gd_dm_driver_rt() + idx;
  73                 struct udevice *dev;
  74                 int ret;
  75
  76                 if (CONFIG_IS_ENABLED(OF_PLATDATA)) {
  77                         int parent_idx = driver_info_parent_id(entry);
  78
  79                         if (drt->dev)
  80                                 continue;
  81
  82                         if (CONFIG_IS_ENABLED(OF_PLATDATA_PARENT) &&
  83                             parent_idx != -1) {
  84                                 struct driver_rt *parent_drt;
  85
  86                                 parent_drt = gd_dm_driver_rt() + parent_idx;
  87                                 if (!parent_drt->dev) {
  88                                         missing_parent = true;
  89                                         continue;
  90                                 }
  91
  92                                 par = parent_drt->dev;
  93                         }
  94                 }
  95                 ret = device_bind_by_name(par, pre_reloc_only, entry, &dev);
  96                 if (!ret) {
  97                         if (CONFIG_IS_ENABLED(OF_PLATDATA))
  98                                 drt->dev = dev;
  99                 } else if (ret != -EPERM) {
 100                         dm_warn("No match for driver '%s'\n", entry->name);
 101                         if (!result || ret != -ENOENT)
 102                                 result = ret;
 103                 }
 104         }
 105
 106         return result ? result : missing_parent ? -EAGAIN : 0;
 107 }
 108
 109 int lists_bind_drivers(struct udevice *parent, bool pre_reloc_only)
 110 {
 111         int result = 0;
 112         int pass;
 113
 114         /*
 115          * 10 passes is 10 levels deep in the devicetree, which is plenty. If
 116          * OF_PLATDATA_PARENT is not enabled, then bind_drivers_pass() will
 117          * always succeed on the first pass.
 118          */
 119         for (pass = 0; pass < 10; pass++) {
 120                 int ret;
 121
 122                 ret = bind_drivers_pass(parent, pre_reloc_only);
 123                 if (!ret)
 124                         break;
 125                 if (ret != -EAGAIN && !result)
 126                         result = ret;
 127         }
 128
 129         return result;
 130 }
 131
 132 int device_bind_driver(struct udevice *parent, const char *drv_name,
 133                        const char *dev_name, struct udevice **devp)
 134 {
 135         return device_bind_driver_to_node(parent, drv_name, dev_name,
 136                                           ofnode_null(), devp);
 137 }
 138
 139 int device_bind_driver_to_node(struct udevice *parent, const char *drv_name,
 140                                const char *dev_name, ofnode node,
 141                                struct udevice **devp)
 142 {
 143         struct driver *drv;
 144         int ret;
 145
 146         drv = lists_driver_lookup_name(drv_name);
 147         if (!drv) {
 148                 debug("Cannot find driver '%s'\n", drv_name);
 149                 return -ENOENT;
 150         }
 151         ret = device_bind_with_driver_data(parent, drv, dev_name, 0 /* data */,
 152                                            node, devp);
 153
 154         return ret;
 155 }
 156
 157 #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
 158 /**
 159  * driver_check_compatible() - Check if a driver matches a compatible string
 160  *
 161  * @param of_match:     List of compatible strings to match
 162  * @param of_idp:       Returns the match that was found
 163  * @param compat:       The compatible string to search for
 164  * @return 0 if there is a match, -ENOENT if no match
 165  */
 166 static int driver_check_compatible(const struct udevice_id *of_match,
 167                                    const struct udevice_id **of_idp,
 168                                    const char *compat)
 169 {
 170         if (!of_match)
 171                 return -ENOENT;
 172
 173         while (of_match->compatible) {
 174                 if (!strcmp(of_match->compatible, compat)) {
 175                         *of_idp = of_match;
 176                         return 0;
 177                 }
 178                 of_match++;
 179         }
 180
 181         return -ENOENT;
 182 }
 183
 184 int lists_bind_fdt(struct udevice *parent, ofnode node, struct udevice **devp,
 185                    struct driver *drv, bool pre_reloc_only)
 186 {
 187         struct driver *driver = ll_entry_start(struct driver, driver);
 188         const int n_ents = ll_entry_count(struct driver, driver);
 189         const struct udevice_id *id;
 190         struct driver *entry;
 191         struct udevice *dev;
 192         bool found = false;
 193         const char *name, *compat_list, *compat;
 194         int compat_length, i;
 195         int result = 0;
 196         int ret = 0;
 197
 198         if (devp)
 199                 *devp = NULL;
 200         name = ofnode_get_name(node);
 201         log_debug("bind node %s\n", name);
 202
 203         compat_list = ofnode_get_property(node, "compatible", &compat_length);
 204         if (!compat_list) {
 205                 if (compat_length == -FDT_ERR_NOTFOUND) {
 206                         log_debug("Device '%s' has no compatible string\n",
 207                                   name);
 208                         return 0;
 209                 }
 210
 211                 dm_warn("Device tree error at node '%s'\n", name);
 212                 return compat_length;
 213         }
 214
 215         /*
 216          * Walk through the compatible string list, attempting to match each
 217          * compatible string in order such that we match in order of priority
 218          * from the first string to the last.
 219          */
 220         for (i = 0; i < compat_length; i += strlen(compat) + 1) {
 221                 compat = compat_list + i;
 222                 log_debug("   - attempt to match compatible string '%s'\n",
 223                           compat);
 224
 225                 for (entry = driver; entry != driver + n_ents; entry++) {
 226                         ret = driver_check_compatible(entry->of_match, &id,
 227                                                       compat);
 228                         if ((drv) && (drv == entry))
 229                                 break;
 230                         if (!ret)
 231                                 break;
 232                 }
 233                 if (entry == driver + n_ents)
 234                         continue;
 235
 236                 if (pre_reloc_only) {
 237                         if (!ofnode_pre_reloc(node) &&
 238                             !(entry->flags & DM_FLAG_PRE_RELOC)) {
 239                                 log_debug("Skipping device pre-relocation\n");
 240                                 return 0;
 241                         }
 242                 }
 243
 244                 log_debug("   - found match at '%s': '%s' matches '%s'\n",
 245                           entry->name, entry->of_match->compatible,
 246                           id->compatible);
 247                 ret = device_bind_with_driver_data(parent, entry, name,
 248                                                    id->data, node, &dev);
 249                 if (ret == -ENODEV) {
 250                         log_debug("Driver '%s' refuses to bind\n", entry->name);
 251                         continue;
 252                 }
 253                 if (ret) {
 254                         dm_warn("Error binding driver '%s': %d\n", entry->name,
 255                                 ret);
 256                         return log_msg_ret("bind", ret);
 257                 } else {
 258                         found = true;
 259                         if (devp)
 260                                 *devp = dev;
 261                 }
 262                 break;
 263         }
 264
 265         if (!found && !result && ret != -ENODEV)
 266                 log_debug("No match for node '%s'\n", name);
 267
 268         return result;
 269 }
 270 #endif