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 (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         device_foreach_child_probe(child, dev) {
  53                 if (device_get_uclass_id(child) != UCLASS_CLK)
  54                         continue;
  55                 if (child == dev)
  56                         continue;
  57                 is_last = list_is_last(&child->sibling_node, &dev->child_head);
  58                 show_clks(child, depth, (last_flag << 1) | is_last);
  59         }
  60 }
  61
  62 int __weak soc_clk_dump(void)
  63 {
  64         struct udevice *dev;
  65
  66         printf(" Rate               Usecnt      Name\n");
  67         printf("------------------------------------------\n");
  68
  69         uclass_foreach_dev_probe(UCLASS_CLK, dev)
  70                 show_clks(dev, -1, 0);
  71
  72         return 0;
  73 }
  74 #else
  75 int __weak soc_clk_dump(void)
  76 {
  77         puts("Not implemented\n");
  78         return 1;
  79 }
  80 #endif
  81
  82 static int do_clk_dump(struct cmd_tbl *cmdtp, int flag, int argc,
  83                        char *const argv[])
  84 {
  85         int ret;
  86
  87         ret = soc_clk_dump();
  88         if (ret < 0) {
  89                 printf("Clock dump error %d\n", ret);
  90                 ret = CMD_RET_FAILURE;
  91         }
  92
  93         return ret;
  94 }
  95
  96 #if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK)
  97 static int do_clk_setfreq(struct cmd_tbl *cmdtp, int flag, int argc,
  98                           char *const argv[])
  99 {
 100         struct clk *clk = NULL;
 101         s32 freq;
 102         struct udevice *dev;
 103
 104         if (argc != 3)
 105                 return CMD_RET_USAGE;
 106
 107         freq = dectoul(argv[2], NULL);
 108
 109         if (!uclass_get_device_by_name(UCLASS_CLK, argv[1], &dev))
 110                 clk = dev_get_clk_ptr(dev);
 111
 112         if (!clk) {
 113                 printf("clock '%s' not found.\n", argv[1]);
 114                 return CMD_RET_FAILURE;
 115         }
 116
 117         freq = clk_set_rate(clk, freq);
 118         if (freq < 0) {
 119                 printf("set_rate failed: %d\n", freq);
 120                 return CMD_RET_FAILURE;
 121         }
 122
 123         printf("set_rate returns %u\n", freq);
 124         return 0;
 125 }
 126 #endif
 127
 128 static struct cmd_tbl cmd_clk_sub[] = {
 129         U_BOOT_CMD_MKENT(dump, 1, 1, do_clk_dump, "", ""),
 130 #if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK)
 131         U_BOOT_CMD_MKENT(setfreq, 3, 1, do_clk_setfreq, "", ""),
 132 #endif
 133 };
 134
 135 static int do_clk(struct cmd_tbl *cmdtp, int flag, int argc,
 136                   char *const argv[])
 137 {
 138         struct cmd_tbl *c;
 139
 140         if (argc < 2)
 141                 return CMD_RET_USAGE;
 142
 143         /* Strip off leading 'clk' command argument */
 144         argc--;
 145         argv++;
 146
 147         c = find_cmd_tbl(argv[0], &cmd_clk_sub[0], ARRAY_SIZE(cmd_clk_sub));
 148
 149         if (c)
 150                 return c->cmd(cmdtp, flag, argc, argv);
 151         else
 152                 return CMD_RET_USAGE;
 153 }
 154
 155 #ifdef CONFIG_SYS_LONGHELP
 156 static char clk_help_text[] =
 157         "dump - Print clock frequencies\n"
 158         "clk setfreq [clk] [freq] - Set clock frequency";
 159 #endif
 160
 161 U_BOOT_CMD(clk, 4, 1, do_clk, "CLK sub-system", clk_help_text);