common: Drop net.h from common header

[oweals/u-boot.git] / drivers / core / syscon-uclass.c

diff --git a/drivers/core/syscon-uclass.c b/drivers/core/syscon-uclass.c
index 01bd9683a7a757ccf20a9a769c83ee1555350cd6..15f0e42a85b45629fda20ecef539cd5e1f7ef5ec 100644 (file)
--- a/drivers/core/syscon-uclass.c
+++ b/drivers/core/syscon-uclass.c
@@ -1,8 +1,7 @@
+// SPDX-License-Identifier: GPL-2.0+
 /*
  * Copyright (C) 2015 Google, Inc
  * Written by Simon Glass <sjg@chromium.org>
- *
- * SPDX-License-Identifier:    GPL-2.0+
  */
 
 #include <common.h>
@@ -11,10 +10,20 @@
 #include <errno.h>
 #include <regmap.h>
 #include <dm/device-internal.h>
+#include <dm/device_compat.h>
 #include <dm/lists.h>
 #include <dm/root.h>
 #include <linux/err.h>
 
+/*
+ * Caution:
+ * This API requires the given device has alerady been bound to syscon driver.
+ * For example,
+ *    compatible = "syscon", "simple-mfd";
+ * works, but
+ *    compatible = "simple-mfd", "syscon";
+ * does not.  The behavior is different from Linux.
+ */
 struct regmap *syscon_get_regmap(struct udevice *dev)
 {
        struct syscon_uc_info *priv;
@@ -29,6 +38,10 @@ static int syscon_pre_probe(struct udevice *dev)
 {
        struct syscon_uc_info *priv = dev_get_uclass_priv(dev);
 
+       /* Special case for PCI devices, which don't have a regmap */
+       if (device_get_uclass_id(dev->parent) == UCLASS_PCI)
+               return 0;
+
        /*
         * With OF_PLATDATA we really have no way of knowing the format of
         * the device-specific platform data. So we assume that it starts with
@@ -41,28 +54,90 @@ static int syscon_pre_probe(struct udevice *dev)
        return regmap_init_mem_platdata(dev, plat->reg, ARRAY_SIZE(plat->reg),
                                        &priv->regmap);
 #else
-       return regmap_init_mem(dev, &priv->regmap);
+       return regmap_init_mem(dev_ofnode(dev), &priv->regmap);
 #endif
 }
 
-int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
+static int syscon_probe_by_ofnode(ofnode node, struct udevice **devp)
 {
-       struct udevice *dev;
-       struct uclass *uc;
+       struct udevice *dev, *parent;
        int ret;
 
-       *devp = NULL;
-       ret = uclass_get(UCLASS_SYSCON, &uc);
-       if (ret)
+       /* found node with "syscon" compatible, not bounded to SYSCON UCLASS */
+       if (!ofnode_device_is_compatible(node, "syscon")) {
+               dev_dbg(dev, "invalid compatible for syscon device\n");
+               return -EINVAL;
+       }
+
+       /* bound to driver with same ofnode or to root if not found */
+       if (device_find_global_by_ofnode(node, &parent))
+               parent = dm_root();
+
+       /* force bound to syscon class */
+       ret = device_bind_driver_to_node(parent, "syscon",
+                                        ofnode_get_name(node),
+                                        node, &dev);
+       if (ret) {
+               dev_dbg(dev, "unable to bound syscon device\n");
+               return ret;
+       }
+       ret = device_probe(dev);
+       if (ret) {
+               dev_dbg(dev, "unable to probe syscon device\n");
                return ret;
-       uclass_foreach_dev(dev, uc) {
-               if (dev->driver_data == driver_data) {
-                       *devp = dev;
-                       return device_probe(dev);
+       }
+
+       *devp = dev;
+       return 0;
+}
+
+struct regmap *syscon_regmap_lookup_by_phandle(struct udevice *dev,
+                                              const char *name)
+{
+       struct udevice *syscon;
+       struct regmap *r;
+       u32 phandle;
+       ofnode node;
+       int err;
+
+       err = uclass_get_device_by_phandle(UCLASS_SYSCON, dev,
+                                          name, &syscon);
+       if (err) {
+               /* found node with "syscon" compatible, not bounded to SYSCON */
+               err = ofnode_read_u32(dev_ofnode(dev), name, &phandle);
+               if (err)
+                       return ERR_PTR(err);
+
+               node = ofnode_get_by_phandle(phandle);
+               if (!ofnode_valid(node)) {
+                       dev_dbg(dev, "unable to find syscon device\n");
+                       return ERR_PTR(-EINVAL);
                }
+               err = syscon_probe_by_ofnode(node, &syscon);
+               if (err)
+                       return ERR_PTR(-ENODEV);
+       }
+
+       r = syscon_get_regmap(syscon);
+       if (!r) {
+               dev_dbg(dev, "unable to find regmap\n");
+               return ERR_PTR(-ENODEV);
        }
 
-       return -ENODEV;
+       return r;
+}
+
+int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
+{
+       int ret;
+
+       *devp = NULL;
+
+       ret = uclass_first_device_drvdata(UCLASS_SYSCON, driver_data, devp);
+       if (ret)
+               return log_msg_ret("find", ret);
+
+       return 0;
 }
 
 struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
@@ -95,3 +170,40 @@ UCLASS_DRIVER(syscon) = {
        .per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
        .pre_probe = syscon_pre_probe,
 };
+
+static const struct udevice_id generic_syscon_ids[] = {
+       { .compatible = "syscon" },
+       { }
+};
+
+U_BOOT_DRIVER(generic_syscon) = {
+       .name   = "syscon",
+       .id     = UCLASS_SYSCON,
+#if !CONFIG_IS_ENABLED(OF_PLATDATA)
+       .bind           = dm_scan_fdt_dev,
+#endif
+       .of_match = generic_syscon_ids,
+};
+
+/*
+ * Linux-compatible syscon-to-regmap
+ * The syscon node can be bound to another driver, but still works
+ * as a syscon provider.
+ */
+struct regmap *syscon_node_to_regmap(ofnode node)
+{
+       struct udevice *dev;
+       struct regmap *r;
+
+       if (uclass_get_device_by_ofnode(UCLASS_SYSCON, node, &dev))
+               if (syscon_probe_by_ofnode(node, &dev))
+                       return ERR_PTR(-ENODEV);
+
+       r = syscon_get_regmap(dev);
+       if (!r) {
+               dev_dbg(dev, "unable to find regmap\n");
+               return ERR_PTR(-ENODEV);
+       }
+
+       return r;
+}