Merge tag 'u-boot-at91-2022.07-a' of https://source.denx.de/u-boot/custodians/u-boot...

[platform/kernel/u-boot.git] / drivers / clk / clk.c

diff --git a/drivers/clk/clk.c b/drivers/clk/clk.c
index 1efb7fe..a5a3461 100644 (file)
--- a/drivers/clk/clk.c
+++ b/drivers/clk/clk.c
@@ -4,14 +4,16 @@
  * Lukasz Majewski, DENX Software Engineering, lukma@denx.de
  */
 
+#define LOG_CATEGORY UCLASS_CLK
+
 #include <common.h>
+#include <clk.h>
 #include <clk-uclass.h>
 #include <log.h>
 #include <dm/device.h>
 #include <dm/uclass.h>
 #include <dm/lists.h>
 #include <dm/device-internal.h>
-#include <clk.h>
 
 int clk_register(struct clk *clk, const char *drv_name,
                 const char *name, const char *parent_name)
@@ -22,24 +24,24 @@ int clk_register(struct clk *clk, const char *drv_name,
 
        ret = uclass_get_device_by_name(UCLASS_CLK, parent_name, &parent);
        if (ret) {
-               printf("%s: failed to get %s device (parent of %s)\n",
-                      __func__, parent_name, name);
+               log_err("%s: failed to get %s device (parent of %s)\n",
+                       __func__, parent_name, name);
        } else {
-               debug("%s: name: %s parent: %s [0x%p]\n", __func__, name,
-                     parent->name, parent);
+               log_debug("%s: name: %s parent: %s [0x%p]\n", __func__, name,
+                         parent->name, parent);
        }
 
        drv = lists_driver_lookup_name(drv_name);
        if (!drv) {
-               printf("%s: %s is not a valid driver name\n",
-                      __func__, drv_name);
+               log_err("%s: %s is not a valid driver name\n",
+                       __func__, drv_name);
                return -ENOENT;
        }
 
        ret = device_bind(parent, drv, name, NULL, ofnode_null(), &clk->dev);
        if (ret) {
-               printf("%s: CLK: %s driver bind error [%d]!\n", __func__, name,
-                      ret);
+               log_err("%s: CLK: %s driver bind error [%d]!\n", __func__, name,
+                       ret);
                return ret;
        }
 
@@ -72,3 +74,68 @@ bool clk_dev_binded(struct clk *clk)
 
        return false;
 }
+
+/* Helper functions for clock ops */
+
+ulong ccf_clk_get_rate(struct clk *clk)
+{
+       struct clk *c;
+       int err = clk_get_by_id(clk->id, &c);
+
+       if (err)
+               return err;
+       return clk_get_rate(c);
+}
+
+ulong ccf_clk_set_rate(struct clk *clk, unsigned long rate)
+{
+       struct clk *c;
+       int err = clk_get_by_id(clk->id, &c);
+
+       if (err)
+               return err;
+       return clk_set_rate(c, rate);
+}
+
+int ccf_clk_set_parent(struct clk *clk, struct clk *parent)
+{
+       struct clk *c, *p;
+       int err = clk_get_by_id(clk->id, &c);
+
+       if (err)
+               return err;
+
+       err = clk_get_by_id(parent->id, &p);
+       if (err)
+               return err;
+
+       return clk_set_parent(c, p);
+}
+
+static int ccf_clk_endisable(struct clk *clk, bool enable)
+{
+       struct clk *c;
+       int err = clk_get_by_id(clk->id, &c);
+
+       if (err)
+               return err;
+       return enable ? clk_enable(c) : clk_disable(c);
+}
+
+int ccf_clk_enable(struct clk *clk)
+{
+       return ccf_clk_endisable(clk, true);
+}
+
+int ccf_clk_disable(struct clk *clk)
+{
+       return ccf_clk_endisable(clk, false);
+}
+
+const struct clk_ops ccf_clk_ops = {
+       .set_rate = ccf_clk_set_rate,
+       .get_rate = ccf_clk_get_rate,
+       .set_parent = ccf_clk_set_parent,
+       .enable = ccf_clk_enable,
+       .disable = ccf_clk_disable,
+};