1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * OMAP clockdomain support |
4 | * |
5 | * Copyright (C) 2013 Texas Instruments, Inc. |
6 | * |
7 | * Tero Kristo <t-kristo@ti.com> |
8 | */ |
9 | |
10 | #include <linux/clk.h> |
11 | #include <linux/clk-provider.h> |
12 | #include <linux/slab.h> |
13 | #include <linux/of.h> |
14 | #include <linux/of_address.h> |
15 | #include <linux/clk/ti.h> |
16 | |
17 | #include "clock.h" |
18 | |
19 | #undef pr_fmt |
20 | #define pr_fmt(fmt) "%s: " fmt, __func__ |
21 | |
22 | /** |
23 | * omap2_clkops_enable_clkdm - increment usecount on clkdm of @hw |
24 | * @hw: struct clk_hw * of the clock being enabled |
25 | * |
26 | * Increment the usecount of the clockdomain of the clock pointed to |
27 | * by @hw; if the usecount is 1, the clockdomain will be "enabled." |
28 | * Only needed for clocks that don't use omap2_dflt_clk_enable() as |
29 | * their enable function pointer. Passes along the return value of |
30 | * clkdm_clk_enable(), -EINVAL if @hw is not associated with a |
31 | * clockdomain, or 0 if clock framework-based clockdomain control is |
32 | * not implemented. |
33 | */ |
34 | int omap2_clkops_enable_clkdm(struct clk_hw *hw) |
35 | { |
36 | struct clk_hw_omap *clk; |
37 | int ret = 0; |
38 | |
39 | clk = to_clk_hw_omap(hw); |
40 | |
41 | if (unlikely(!clk->clkdm)) { |
42 | pr_err("%s: %s: no clkdm set ?!\n" , __func__, |
43 | clk_hw_get_name(hw)); |
44 | return -EINVAL; |
45 | } |
46 | |
47 | if (ti_clk_get_features()->flags & TI_CLK_DISABLE_CLKDM_CONTROL) { |
48 | pr_err("%s: %s: clkfw-based clockdomain control disabled ?!\n" , |
49 | __func__, clk_hw_get_name(hw)); |
50 | return 0; |
51 | } |
52 | |
53 | ret = ti_clk_ll_ops->clkdm_clk_enable(clk->clkdm, hw->clk); |
54 | WARN(ret, "%s: could not enable %s's clockdomain %s: %d\n" , |
55 | __func__, clk_hw_get_name(hw), clk->clkdm_name, ret); |
56 | |
57 | return ret; |
58 | } |
59 | |
60 | /** |
61 | * omap2_clkops_disable_clkdm - decrement usecount on clkdm of @hw |
62 | * @hw: struct clk_hw * of the clock being disabled |
63 | * |
64 | * Decrement the usecount of the clockdomain of the clock pointed to |
65 | * by @hw; if the usecount is 0, the clockdomain will be "disabled." |
66 | * Only needed for clocks that don't use omap2_dflt_clk_disable() as their |
67 | * disable function pointer. No return value. |
68 | */ |
69 | void omap2_clkops_disable_clkdm(struct clk_hw *hw) |
70 | { |
71 | struct clk_hw_omap *clk; |
72 | |
73 | clk = to_clk_hw_omap(hw); |
74 | |
75 | if (unlikely(!clk->clkdm)) { |
76 | pr_err("%s: %s: no clkdm set ?!\n" , __func__, |
77 | clk_hw_get_name(hw)); |
78 | return; |
79 | } |
80 | |
81 | if (ti_clk_get_features()->flags & TI_CLK_DISABLE_CLKDM_CONTROL) { |
82 | pr_err("%s: %s: clkfw-based clockdomain control disabled ?!\n" , |
83 | __func__, clk_hw_get_name(hw)); |
84 | return; |
85 | } |
86 | |
87 | ti_clk_ll_ops->clkdm_clk_disable(clk->clkdm, hw->clk); |
88 | } |
89 | |
90 | /** |
91 | * omap2_init_clk_clkdm - look up a clockdomain name, store pointer in clk |
92 | * @hw: Pointer to clk_hw_omap used to obtain OMAP clock struct ptr to use |
93 | * |
94 | * Convert a clockdomain name stored in a struct clk 'clk' into a |
95 | * clockdomain pointer, and save it into the struct clk. Intended to be |
96 | * called during clk_register(). Returns 0 on success, -EERROR otherwise. |
97 | */ |
98 | int omap2_init_clk_clkdm(struct clk_hw *hw) |
99 | { |
100 | struct clk_hw_omap *clk = to_clk_hw_omap(hw); |
101 | struct clockdomain *clkdm; |
102 | const char *clk_name; |
103 | |
104 | if (!clk->clkdm_name) |
105 | return 0; |
106 | |
107 | clk_name = __clk_get_name(clk: hw->clk); |
108 | |
109 | clkdm = ti_clk_ll_ops->clkdm_lookup(clk->clkdm_name); |
110 | if (clkdm) { |
111 | pr_debug("clock: associated clk %s to clkdm %s\n" , |
112 | clk_name, clk->clkdm_name); |
113 | clk->clkdm = clkdm; |
114 | } else { |
115 | pr_debug("clock: could not associate clk %s to clkdm %s\n" , |
116 | clk_name, clk->clkdm_name); |
117 | } |
118 | |
119 | return 0; |
120 | } |
121 | |
122 | static void __init of_ti_clockdomain_setup(struct device_node *node) |
123 | { |
124 | struct clk *clk; |
125 | struct clk_hw *clk_hw; |
126 | const char *clkdm_name = ti_dt_clk_name(np: node); |
127 | int i; |
128 | unsigned int num_clks; |
129 | |
130 | num_clks = of_clk_get_parent_count(np: node); |
131 | |
132 | for (i = 0; i < num_clks; i++) { |
133 | clk = of_clk_get(np: node, index: i); |
134 | if (IS_ERR(ptr: clk)) { |
135 | pr_err("%s: Failed get %pOF' clock nr %d (%ld)\n" , |
136 | __func__, node, i, PTR_ERR(clk)); |
137 | continue; |
138 | } |
139 | clk_hw = __clk_get_hw(clk); |
140 | if (!omap2_clk_is_hw_omap(hw: clk_hw)) { |
141 | pr_warn("can't setup clkdm for basic clk %s\n" , |
142 | __clk_get_name(clk)); |
143 | clk_put(clk); |
144 | continue; |
145 | } |
146 | to_clk_hw_omap(clk_hw)->clkdm_name = clkdm_name; |
147 | omap2_init_clk_clkdm(hw: clk_hw); |
148 | clk_put(clk); |
149 | } |
150 | } |
151 | |
152 | static const struct of_device_id ti_clkdm_match_table[] __initconst = { |
153 | { .compatible = "ti,clockdomain" }, |
154 | { } |
155 | }; |
156 | |
157 | /** |
158 | * ti_dt_clockdomains_setup - setup device tree clockdomains |
159 | * |
160 | * Initializes clockdomain nodes for a SoC. This parses through all the |
161 | * nodes with compatible = "ti,clockdomain", and add the clockdomain |
162 | * info for all the clocks listed under these. This function shall be |
163 | * called after rest of the DT clock init has completed and all |
164 | * clock nodes have been registered. |
165 | */ |
166 | void __init ti_dt_clockdomains_setup(void) |
167 | { |
168 | struct device_node *np; |
169 | for_each_matching_node(np, ti_clkdm_match_table) { |
170 | of_ti_clockdomain_setup(node: np); |
171 | } |
172 | } |
173 | |