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 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
soc_clk_dump(void)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
soc_clk_dump(void)68 int __weak soc_clk_dump(void)
69 {
70 puts("Not implemented\n");
71 return 1;
72 }
73 #endif
74
do_clk_dump(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_clk(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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);
119