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;
  22         u32 rate;
  23
  24         clkp = dev_get_clk_ptr(dev);
  25         if (device_get_uclass_id(dev) == UCLASS_CLK && clkp) {
  26                 depth++;
  27                 rate = clk_get_rate(clkp);
  28
  29                 printf(" %-12u  %8d        ", rate, clkp->enable_count);
  30
  31                 for (i = depth; i >= 0; i--) {
  32                         is_last = (last_flag >> i) & 1;
  33                         if (i) {
  34                                 if (is_last)
  35                                         printf("    ");
  36                                 else
  37                                         printf("|   ");
  38                         } else {
  39                                 if (is_last)
  40                                         printf("`-- ");
  41                                 else
  42                                         printf("|-- ");
  43                         }
  44                 }
  45
  46                 printf("%s\n", dev->name);
  47         }
  48
  49         list_for_each_entry(child, &dev->child_head, sibling_node) {
  50                 is_last = list_is_last(&child->sibling_node, &dev->child_head);
  51                 show_clks(child, depth, (last_flag << 1) | is_last);
  52         }
  53 }
  54
  55 int __weak soc_clk_dump(void)
  56 {
  57         struct udevice *root;
  58
  59         root = dm_root();
  60         if (root) {
  61                 printf(" Rate               Usecnt      Name\n");
  62                 printf("------------------------------------------\n");
  63                 show_clks(root, -1, 0);
  64         }
  65
  66         return 0;
  67 }
  68 #else
  69 int __weak soc_clk_dump(void)
  70 {
  71         puts("Not implemented\n");
  72         return 1;
  73 }
  74 #endif
  75
  76 static int do_clk_dump(struct cmd_tbl *cmdtp, int flag, int argc,
  77                        char *const argv[])
  78 {
  79         int ret;
  80
  81         ret = soc_clk_dump();
  82         if (ret < 0) {
  83                 printf("Clock dump error %d\n", ret);
  84                 ret = CMD_RET_FAILURE;
  85         }
  86
  87         return ret;
  88 }
  89
  90 static struct cmd_tbl cmd_clk_sub[] = {
  91         U_BOOT_CMD_MKENT(dump, 1, 1, do_clk_dump, "", ""),
  92 };
  93
  94 static int do_clk(struct cmd_tbl *cmdtp, int flag, int argc,
  95                   char *const argv[])
  96 {
  97         struct cmd_tbl *c;
  98
  99         if (argc < 2)
 100                 return CMD_RET_USAGE;
 101
 102         /* Strip off leading 'clk' command argument */
 103         argc--;
 104         argv++;
 105
 106         c = find_cmd_tbl(argv[0], &cmd_clk_sub[0], ARRAY_SIZE(cmd_clk_sub));
 107
 108         if (c)
 109                 return c->cmd(cmdtp, flag, argc, argv);
 110         else
 111                 return CMD_RET_USAGE;
 112 }
 113
 114 #ifdef CONFIG_SYS_LONGHELP
 115 static char clk_help_text[] =
 116         "dump - Print clock frequencies";
 117 #endif
 118
 119 U_BOOT_CMD(clk, 2, 1, do_clk, "CLK sub-system", clk_help_text);