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