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, *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
soc_clk_dump(void)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
soc_clk_dump(void)75 int __weak soc_clk_dump(void)
76 {
77 puts("Not implemented\n");
78 return 1;
79 }
80 #endif
81
do_clk_dump(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])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)
do_clk_setfreq(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])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
do_clk(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])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);
162