2 * Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
4 * This software is licensed under the terms of the GNU General Public
5 * License version 2, as published by the Free Software Foundation, and
6 * may be copied, distributed, and modified under those terms.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 #include <linux/export.h>
15 #include <linux/module.h>
16 #include <linux/regmap.h>
17 #include <linux/platform_device.h>
18 #include <linux/clk-provider.h>
19 #include <linux/reset-controller.h>
24 #include "clk-regmap.h"
29 struct qcom_reset_controller reset
;
30 struct clk_regmap
**rclks
;
35 struct freq_tbl
*qcom_find_freq(const struct freq_tbl
*f
, unsigned long rate
)
47 /* Default to our fastest rate */
50 EXPORT_SYMBOL_GPL(qcom_find_freq
);
52 const struct freq_tbl
*qcom_find_freq_floor(const struct freq_tbl
*f
,
55 const struct freq_tbl
*best
= NULL
;
57 for ( ; f
->freq
; f
++) {
66 EXPORT_SYMBOL_GPL(qcom_find_freq_floor
);
68 int qcom_find_src_index(struct clk_hw
*hw
, const struct parent_map
*map
, u8 src
)
70 int i
, num_parents
= clk_hw_get_num_parents(hw
);
72 for (i
= 0; i
< num_parents
; i
++)
73 if (src
== map
[i
].src
)
78 EXPORT_SYMBOL_GPL(qcom_find_src_index
);
81 qcom_cc_map(struct platform_device
*pdev
, const struct qcom_cc_desc
*desc
)
85 struct device
*dev
= &pdev
->dev
;
87 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
88 base
= devm_ioremap_resource(dev
, res
);
90 return ERR_CAST(base
);
92 return devm_regmap_init_mmio(dev
, base
, desc
->config
);
94 EXPORT_SYMBOL_GPL(qcom_cc_map
);
97 qcom_pll_set_fsm_mode(struct regmap
*map
, u32 reg
, u8 bias_count
, u8 lock_count
)
102 /* De-assert reset to FSM */
103 regmap_update_bits(map
, reg
, PLL_VOTE_FSM_RESET
, 0);
105 /* Program bias count and lock count */
106 val
= bias_count
<< PLL_BIAS_COUNT_SHIFT
|
107 lock_count
<< PLL_LOCK_COUNT_SHIFT
;
108 mask
= PLL_BIAS_COUNT_MASK
<< PLL_BIAS_COUNT_SHIFT
;
109 mask
|= PLL_LOCK_COUNT_MASK
<< PLL_LOCK_COUNT_SHIFT
;
110 regmap_update_bits(map
, reg
, mask
, val
);
112 /* Enable PLL FSM voting */
113 regmap_update_bits(map
, reg
, PLL_VOTE_FSM_ENA
, PLL_VOTE_FSM_ENA
);
115 EXPORT_SYMBOL_GPL(qcom_pll_set_fsm_mode
);
117 static void qcom_cc_gdsc_unregister(void *data
)
119 gdsc_unregister(data
);
123 * Backwards compatibility with old DTs. Register a pass-through factor 1/1
124 * clock to translate 'path' clk into 'name' clk and register the 'path'
125 * clk as a fixed rate clock if it isn't present.
127 static int _qcom_cc_register_board_clk(struct device
*dev
, const char *path
,
128 const char *name
, unsigned long rate
,
131 struct device_node
*node
= NULL
;
132 struct device_node
*clocks_node
;
133 struct clk_fixed_factor
*factor
;
134 struct clk_fixed_rate
*fixed
;
135 struct clk_init_data init_data
= { };
138 clocks_node
= of_find_node_by_path("/clocks");
140 node
= of_get_child_by_name(clocks_node
, path
);
141 of_node_put(clocks_node
);
145 fixed
= devm_kzalloc(dev
, sizeof(*fixed
), GFP_KERNEL
);
149 fixed
->fixed_rate
= rate
;
150 fixed
->hw
.init
= &init_data
;
152 init_data
.name
= path
;
153 init_data
.ops
= &clk_fixed_rate_ops
;
155 ret
= devm_clk_hw_register(dev
, &fixed
->hw
);
162 factor
= devm_kzalloc(dev
, sizeof(*factor
), GFP_KERNEL
);
166 factor
->mult
= factor
->div
= 1;
167 factor
->hw
.init
= &init_data
;
169 init_data
.name
= name
;
170 init_data
.parent_names
= &path
;
171 init_data
.num_parents
= 1;
173 init_data
.ops
= &clk_fixed_factor_ops
;
175 ret
= devm_clk_hw_register(dev
, &factor
->hw
);
183 int qcom_cc_register_board_clk(struct device
*dev
, const char *path
,
184 const char *name
, unsigned long rate
)
186 bool add_factor
= true;
189 * TODO: The RPM clock driver currently does not support the xo clock.
190 * When xo is added to the RPM clock driver, we should change this
191 * function to skip registration of xo factor clocks.
194 return _qcom_cc_register_board_clk(dev
, path
, name
, rate
, add_factor
);
196 EXPORT_SYMBOL_GPL(qcom_cc_register_board_clk
);
198 int qcom_cc_register_sleep_clk(struct device
*dev
)
200 return _qcom_cc_register_board_clk(dev
, "sleep_clk", "sleep_clk_src",
203 EXPORT_SYMBOL_GPL(qcom_cc_register_sleep_clk
);
205 static struct clk_hw
*qcom_cc_clk_hw_get(struct of_phandle_args
*clkspec
,
208 struct qcom_cc
*cc
= data
;
209 unsigned int idx
= clkspec
->args
[0];
211 if (idx
>= cc
->num_rclks
) {
212 pr_err("%s: invalid index %u\n", __func__
, idx
);
213 return ERR_PTR(-EINVAL
);
216 return cc
->rclks
[idx
] ? &cc
->rclks
[idx
]->hw
: ERR_PTR(-ENOENT
);
219 int qcom_cc_really_probe(struct platform_device
*pdev
,
220 const struct qcom_cc_desc
*desc
, struct regmap
*regmap
)
223 struct device
*dev
= &pdev
->dev
;
224 struct qcom_reset_controller
*reset
;
226 struct gdsc_desc
*scd
;
227 size_t num_clks
= desc
->num_clks
;
228 struct clk_regmap
**rclks
= desc
->clks
;
230 cc
= devm_kzalloc(dev
, sizeof(*cc
), GFP_KERNEL
);
235 cc
->num_rclks
= num_clks
;
237 for (i
= 0; i
< num_clks
; i
++) {
241 ret
= devm_clk_register_regmap(dev
, rclks
[i
]);
246 ret
= devm_of_clk_add_hw_provider(dev
, qcom_cc_clk_hw_get
, cc
);
251 reset
->rcdev
.of_node
= dev
->of_node
;
252 reset
->rcdev
.ops
= &qcom_reset_ops
;
253 reset
->rcdev
.owner
= dev
->driver
->owner
;
254 reset
->rcdev
.nr_resets
= desc
->num_resets
;
255 reset
->regmap
= regmap
;
256 reset
->reset_map
= desc
->resets
;
258 ret
= devm_reset_controller_register(dev
, &reset
->rcdev
);
262 if (desc
->gdscs
&& desc
->num_gdscs
) {
263 scd
= devm_kzalloc(dev
, sizeof(*scd
), GFP_KERNEL
);
267 scd
->scs
= desc
->gdscs
;
268 scd
->num
= desc
->num_gdscs
;
269 ret
= gdsc_register(scd
, &reset
->rcdev
, regmap
);
272 ret
= devm_add_action_or_reset(dev
, qcom_cc_gdsc_unregister
,
280 EXPORT_SYMBOL_GPL(qcom_cc_really_probe
);
282 int qcom_cc_probe(struct platform_device
*pdev
, const struct qcom_cc_desc
*desc
)
284 struct regmap
*regmap
;
286 regmap
= qcom_cc_map(pdev
, desc
);
288 return PTR_ERR(regmap
);
290 return qcom_cc_really_probe(pdev
, desc
, regmap
);
292 EXPORT_SYMBOL_GPL(qcom_cc_probe
);
294 MODULE_LICENSE("GPL v2");