cmd/clk.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2013 Xilinx, Inc.
   4  */
   5 #include <common.h>
   6 #include <command.h>
   7 #include <clk.h>
   8 #if defined(CONFIG_DM) && defined(CONFIG_CLK)
   9 #include <dm.h>
  10 #include <dm/device.h>
  11 #include <dm/root.h>
  12 #include <dm/device-internal.h>
  13 #include <linux/clk-provider.h>
  14 #endif
  15
  16 #if defined(CONFIG_DM) && defined(CONFIG_CLK)
  17 static void show_clks(struct udevice *dev, int depth, int last_flag)
  18 {
  19         int i, is_last;
  20         struct udevice *child;
  21         struct clk *clkp, *parent;
  22         u32 rate;
  23
  24         clkp = dev_get_clk_ptr(dev);
  25         if (device_get_uclass_id(dev) == UCLASS_CLK && clkp) {
  26                 parent = clk_get_parent(clkp);
  27                 if (!IS_ERR(parent) && depth == -1)
  28                         return;
  29                 depth++;
  30                 rate = clk_get_rate(clkp);
  31
  32                 printf(" %-12u  %8d        ", rate, clkp->enable_count);
  33
  34                 for (i = depth; i >= 0; i--) {
  35                         is_last = (last_flag >> i) & 1;
  36                         if (i) {
  37                                 if (is_last)
  38                                         printf("    ");
  39                                 else
  40                                         printf("|   ");
  41                         } else {
  42                                 if (is_last)
  43                                         printf("`-- ");
  44                                 else
  45                                         printf("|-- ");
  46                         }
  47                 }
  48
  49                 printf("%s\n", dev->name);
  50         }
  51
  52         list_for_each_entry(child, &dev->child_head, sibling_node) {
  53                 if (child == dev)
  54                         continue;
  55
  56                 is_last = list_is_last(&child->sibling_node, &dev->child_head);
  57                 show_clks(child, depth, (last_flag << 1) | is_last);
  58         }
  59 }
  60
  61 int __weak soc_clk_dump(void)
  62 {
  63         struct udevice *dev;
  64         struct uclass *uc;
  65         int ret;
  66
  67         ret = uclass_get(UCLASS_CLK, &uc);
  68         if (ret)
  69                 return ret;
  70
  71         printf(" Rate               Usecnt      Name\n");
  72         printf("------------------------------------------\n");
  73
  74         uclass_foreach_dev(dev, uc)
  75                 show_clks(dev, -1, 0);
  76
  77         return 0;
  78 }
  79 #else
  80 int __weak soc_clk_dump(void)
  81 {
  82         puts("Not implemented\n");
  83         return 1;
  84 }
  85 #endif
  86
  87 static int do_clk_dump(struct cmd_tbl *cmdtp, int flag, int argc,
  88                        char *const argv[])
  89 {
  90         int ret;
  91
  92         ret = soc_clk_dump();
  93         if (ret < 0) {
  94                 printf("Clock dump error %d\n", ret);
  95                 ret = CMD_RET_FAILURE;
  96         }
  97
  98         return ret;
  99 }
 100
 101 static struct cmd_tbl cmd_clk_sub[] = {
 102         U_BOOT_CMD_MKENT(dump, 1, 1, do_clk_dump, "", ""),
 103 };
 104
 105 static int do_clk(struct cmd_tbl *cmdtp, int flag, int argc,
 106                   char *const argv[])
 107 {
 108         struct cmd_tbl *c;
 109
 110         if (argc < 2)
 111                 return CMD_RET_USAGE;
 112
 113         /* Strip off leading 'clk' command argument */
 114         argc--;
 115         argv++;
 116
 117         c = find_cmd_tbl(argv[0], &cmd_clk_sub[0], ARRAY_SIZE(cmd_clk_sub));
 118
 119         if (c)
 120                 return c->cmd(cmdtp, flag, argc, argv);
 121         else
 122                 return CMD_RET_USAGE;
 123 }
 124
 125 #ifdef CONFIG_SYS_LONGHELP
 126 static char clk_help_text[] =
 127         "dump - Print clock frequencies";
 128 #endif
 129
 130 U_BOOT_CMD(clk, 2, 1, do_clk, "CLK sub-system", clk_help_text);