eficonfig: expose append entry function

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

diff --git a/cmd/clk.c b/cmd/clk.c
index fd42315..a483fd8 100644 (file)
--- a/cmd/clk.c
+++ b/cmd/clk.c
@@ -7,49 +7,84 @@
 #include <clk.h>
 #if defined(CONFIG_DM) && defined(CONFIG_CLK)
 #include <dm.h>
+#include <dm/device.h>
+#include <dm/root.h>
 #include <dm/device-internal.h>
+#include <linux/clk-provider.h>
 #endif
 
+#if defined(CONFIG_DM) && defined(CONFIG_CLK)
+static void show_clks(struct udevice *dev, int depth, int last_flag)
+{
+       int i, is_last;
+       struct udevice *child;
+       struct clk *clkp, *parent;
+       u32 rate;
+
+       clkp = dev_get_clk_ptr(dev);
+       if (device_get_uclass_id(dev) == UCLASS_CLK && clkp) {
+               parent = clk_get_parent(clkp);
+               if (!IS_ERR(parent) && depth == -1)
+                       return;
+               depth++;
+               rate = clk_get_rate(clkp);
+
+               printf(" %-12u  %8d        ", rate, clkp->enable_count);
+
+               for (i = depth; i >= 0; i--) {
+                       is_last = (last_flag >> i) & 1;
+                       if (i) {
+                               if (is_last)
+                                       printf("    ");
+                               else
+                                       printf("|   ");
+                       } else {
+                               if (is_last)
+                                       printf("`-- ");
+                               else
+                                       printf("|-- ");
+                       }
+               }
+
+               printf("%s\n", dev->name);
+       }
+
+       list_for_each_entry(child, &dev->child_head, sibling_node) {
+               if (child == dev)
+                       continue;
+
+               is_last = list_is_last(&child->sibling_node, &dev->child_head);
+               show_clks(child, depth, (last_flag << 1) | is_last);
+       }
+}
+
 int __weak soc_clk_dump(void)
 {
-#if defined(CONFIG_DM) && defined(CONFIG_CLK)
        struct udevice *dev;
        struct uclass *uc;
-       struct clk clk;
        int ret;
 
-       /* Device addresses start at 1 */
        ret = uclass_get(UCLASS_CLK, &uc);
        if (ret)
                return ret;
 
-       uclass_foreach_dev(dev, uc) {
-               memset(&clk, 0, sizeof(clk));
-               ret = device_probe(dev);
-               if (ret) {
-                       printf("%-30.30s : ? Hz\n", dev->name);
-                       continue;
-               }
-
-               ret = clk_request(dev, &clk);
-               if (ret) {
-                       printf("%-30.30s : ? Hz\n", dev->name);
-                       continue;
-               }
+       printf(" Rate               Usecnt      Name\n");
+       printf("------------------------------------------\n");
 
-               printf("%-30.30s : %lu Hz\n", dev->name, clk_get_rate(&clk));
-
-               clk_free(&clk);
-       }
+       uclass_foreach_dev(dev, uc)
+               show_clks(dev, -1, 0);
 
        return 0;
+}
 #else
+int __weak soc_clk_dump(void)
+{
        puts("Not implemented\n");
        return 1;
-#endif
 }
+#endif
 
-static int do_clk_dump(cmd_tbl_t *cmdtp, int flag, int argc,
+static int do_clk_dump(struct cmd_tbl *cmdtp, int flag, int argc,
                       char *const argv[])
 {
        int ret;
@@ -63,14 +98,49 @@ static int do_clk_dump(cmd_tbl_t *cmdtp, int flag, int argc,
        return ret;
 }
 
-static cmd_tbl_t cmd_clk_sub[] = {
+#if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK)
+static int do_clk_setfreq(struct cmd_tbl *cmdtp, int flag, int argc,
+                         char *const argv[])
+{
+       struct clk *clk = NULL;
+       s32 freq;
+       struct udevice *dev;
+
+       if (argc != 3)
+               return CMD_RET_USAGE;
+
+       freq = dectoul(argv[2], NULL);
+
+       if (!uclass_get_device_by_name(UCLASS_CLK, argv[1], &dev))
+               clk = dev_get_clk_ptr(dev);
+
+       if (!clk) {
+               printf("clock '%s' not found.\n", argv[1]);
+               return CMD_RET_FAILURE;
+       }
+
+       freq = clk_set_rate(clk, freq);
+       if (freq < 0) {
+               printf("set_rate failed: %d\n", freq);
+               return CMD_RET_FAILURE;
+       }
+
+       printf("set_rate returns %u\n", freq);
+       return 0;
+}
+#endif
+
+static struct cmd_tbl cmd_clk_sub[] = {
        U_BOOT_CMD_MKENT(dump, 1, 1, do_clk_dump, "", ""),
+#if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK)
+       U_BOOT_CMD_MKENT(setfreq, 3, 1, do_clk_setfreq, "", ""),
+#endif
 };
 
-static int do_clk(cmd_tbl_t *cmdtp, int flag, int argc,
+static int do_clk(struct cmd_tbl *cmdtp, int flag, int argc,
                  char *const argv[])
 {
-       cmd_tbl_t *c;
+       struct cmd_tbl *c;
 
        if (argc < 2)
                return CMD_RET_USAGE;
@@ -89,7 +159,8 @@ static int do_clk(cmd_tbl_t *cmdtp, int flag, int argc,
 
 #ifdef CONFIG_SYS_LONGHELP
 static char clk_help_text[] =
-       "dump - Print clock frequencies";
+       "dump - Print clock frequencies\n"
+       "clk setfreq [clk] [freq] - Set clock frequency";
 #endif
 
-U_BOOT_CMD(clk, 2, 1, do_clk, "CLK sub-system", clk_help_text);
+U_BOOT_CMD(clk, 4, 1, do_clk, "CLK sub-system", clk_help_text);