Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 | // SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2013 Xilinx, Inc. */ #include <common.h> #include <command.h> #include <clk.h> #if defined(CONFIG_DM) && defined(CONFIG_CLK) #include <dm.h> #include <dm/device.h> #include <dm/root.h> #include <dm/device-internal.h> #include <linux/clk-provider.h> #endif #if defined(CONFIG_DM) && defined(CONFIG_CLK) static void show_clks(struct udevice *dev, int depth, int last_flag) { int i, is_last; struct udevice *child; struct clk *clkp, *parent; u32 rate; clkp = dev_get_clk_ptr(dev); if (device_get_uclass_id(dev) == UCLASS_CLK && clkp) { parent = clk_get_parent(clkp); if (!IS_ERR(parent) && depth == -1) return; depth++; rate = clk_get_rate(clkp); printf(" %-12u %8d ", rate, clkp->enable_count); for (i = depth; i >= 0; i--) { is_last = (last_flag >> i) & 1; if (i) { if (is_last) printf(" "); else printf("| "); } else { if (is_last) printf("`-- "); else printf("|-- "); } } printf("%s\n", dev->name); } list_for_each_entry(child, &dev->child_head, sibling_node) { if (child == dev) continue; is_last = list_is_last(&child->sibling_node, &dev->child_head); show_clks(child, depth, (last_flag << 1) | is_last); } } int __weak soc_clk_dump(void) { struct udevice *dev; struct uclass *uc; int ret; ret = uclass_get(UCLASS_CLK, &uc); if (ret) return ret; printf(" Rate Usecnt Name\n"); printf("------------------------------------------\n"); uclass_foreach_dev(dev, uc) show_clks(dev, -1, 0); return 0; } #else int __weak soc_clk_dump(void) { puts("Not implemented\n"); return 1; } #endif static int do_clk_dump(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { int ret; ret = soc_clk_dump(); if (ret < 0) { printf("Clock dump error %d\n", ret); ret = CMD_RET_FAILURE; } return ret; } #if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK) struct udevice *clk_lookup(const char *name) { int i = 0; struct udevice *dev; do { uclass_get_device(UCLASS_CLK, i++, &dev); if (!strcmp(name, dev->name)) return dev; } while (dev); return NULL; } static int do_clk_setfreq(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { struct clk *clk = NULL; s32 freq; struct udevice *dev; freq = dectoul(argv[2], NULL); dev = clk_lookup(argv[1]); if (dev) clk = dev_get_clk_ptr(dev); if (!clk) { printf("clock '%s' not found.\n", argv[1]); return -EINVAL; } freq = clk_set_rate(clk, freq); if (freq < 0) { printf("set_rate failed: %d\n", freq); return CMD_RET_FAILURE; } printf("set_rate returns %u\n", freq); return 0; } #endif static struct cmd_tbl cmd_clk_sub[] = { U_BOOT_CMD_MKENT(dump, 1, 1, do_clk_dump, "", ""), #if CONFIG_IS_ENABLED(DM) && CONFIG_IS_ENABLED(CLK) U_BOOT_CMD_MKENT(setfreq, 3, 1, do_clk_setfreq, "", ""), #endif }; static int do_clk(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { struct cmd_tbl *c; if (argc < 2) return CMD_RET_USAGE; /* Strip off leading 'clk' command argument */ argc--; argv++; c = find_cmd_tbl(argv[0], &cmd_clk_sub[0], ARRAY_SIZE(cmd_clk_sub)); if (c) return c->cmd(cmdtp, flag, argc, argv); else return CMD_RET_USAGE; } #ifdef CONFIG_SYS_LONGHELP static char clk_help_text[] = "dump - Print clock frequencies\n" "setfreq [clk] [freq] - Set clock frequency"; #endif U_BOOT_CMD(clk, 4, 1, do_clk, "CLK sub-system", clk_help_text); |