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)
show_clks(struct udevice * dev,int depth,int last_flag)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
soc_clk_dump(void)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
soc_clk_dump(void)69 int __weak soc_clk_dump(void)
70 {
71 puts("Not implemented\n");
72 return 1;
73 }
74 #endif
75
do_clk_dump(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])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
do_clk(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])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);
120