1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Clkout driver for Rockchip RK808
4 *
5 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
6 *
7 * Author:Chris Zhong <zyw@rock-chips.com>
8 */
9
10#include <linux/clk-provider.h>
11#include <linux/module.h>
12#include <linux/slab.h>
13#include <linux/platform_device.h>
14#include <linux/mfd/rk808.h>
15
16struct rk808_clkout {
17	struct regmap		*regmap;
18	struct clk_hw		clkout1_hw;
19	struct clk_hw		clkout2_hw;
20};
21
22static unsigned long rk808_clkout_recalc_rate(struct clk_hw *hw,
23					      unsigned long parent_rate)
24{
25	return 32768;
26}
27
28static int rk808_clkout2_enable(struct clk_hw *hw, bool enable)
29{
30	struct rk808_clkout *rk808_clkout = container_of(hw,
31							 struct rk808_clkout,
32							 clkout2_hw);
33
34	return regmap_update_bits(rk808_clkout->regmap, RK808_CLK32OUT_REG,
35				  CLK32KOUT2_EN, enable ? CLK32KOUT2_EN : 0);
36}
37
38static int rk808_clkout2_prepare(struct clk_hw *hw)
39{
40	return rk808_clkout2_enable(hw, true);
41}
42
43static void rk808_clkout2_unprepare(struct clk_hw *hw)
44{
45	rk808_clkout2_enable(hw, false);
46}
47
48static int rk808_clkout2_is_prepared(struct clk_hw *hw)
49{
50	struct rk808_clkout *rk808_clkout = container_of(hw,
51							 struct rk808_clkout,
52							 clkout2_hw);
53	uint32_t val;
54
55	int ret = regmap_read(rk808_clkout->regmap, RK808_CLK32OUT_REG, &val);
56
57	if (ret < 0)
58		return ret;
59
60	return (val & CLK32KOUT2_EN) ? 1 : 0;
61}
62
63static const struct clk_ops rk808_clkout1_ops = {
64	.recalc_rate = rk808_clkout_recalc_rate,
65};
66
67static const struct clk_ops rk808_clkout2_ops = {
68	.prepare = rk808_clkout2_prepare,
69	.unprepare = rk808_clkout2_unprepare,
70	.is_prepared = rk808_clkout2_is_prepared,
71	.recalc_rate = rk808_clkout_recalc_rate,
72};
73
74static struct clk_hw *
75of_clk_rk808_get(struct of_phandle_args *clkspec, void *data)
76{
77	struct rk808_clkout *rk808_clkout = data;
78	unsigned int idx = clkspec->args[0];
79
80	if (idx >= 2) {
81		pr_err("%s: invalid index %u\n", __func__, idx);
82		return ERR_PTR(-EINVAL);
83	}
84
85	return idx ? &rk808_clkout->clkout2_hw : &rk808_clkout->clkout1_hw;
86}
87
88static int rk817_clkout2_enable(struct clk_hw *hw, bool enable)
89{
90	struct rk808_clkout *rk808_clkout = container_of(hw,
91							 struct rk808_clkout,
92							 clkout2_hw);
93
94	return regmap_update_bits(rk808_clkout->regmap, RK817_SYS_CFG(1),
95				  RK817_CLK32KOUT2_EN,
96				  enable ? RK817_CLK32KOUT2_EN : 0);
97}
98
99static int rk817_clkout2_prepare(struct clk_hw *hw)
100{
101	return rk817_clkout2_enable(hw, true);
102}
103
104static void rk817_clkout2_unprepare(struct clk_hw *hw)
105{
106	rk817_clkout2_enable(hw, false);
107}
108
109static int rk817_clkout2_is_prepared(struct clk_hw *hw)
110{
111	struct rk808_clkout *rk808_clkout = container_of(hw,
112							 struct rk808_clkout,
113							 clkout2_hw);
114	unsigned int val;
115
116	int ret = regmap_read(rk808_clkout->regmap, RK817_SYS_CFG(1), &val);
117
118	if (ret < 0)
119		return 0;
120
121	return (val & RK817_CLK32KOUT2_EN) ? 1 : 0;
122}
123
124static const struct clk_ops rk817_clkout2_ops = {
125	.prepare = rk817_clkout2_prepare,
126	.unprepare = rk817_clkout2_unprepare,
127	.is_prepared = rk817_clkout2_is_prepared,
128	.recalc_rate = rk808_clkout_recalc_rate,
129};
130
131static const struct clk_ops *rkpmic_get_ops(long variant)
132{
133	switch (variant) {
134	case RK809_ID:
135	case RK817_ID:
136		return &rk817_clkout2_ops;
137	/*
138	 * For the default case, it match the following PMIC type.
139	 * RK805_ID
140	 * RK808_ID
141	 * RK818_ID
142	 */
143	default:
144		return &rk808_clkout2_ops;
145	}
146}
147
148static int rk808_clkout_probe(struct platform_device *pdev)
149{
150	struct rk808 *rk808 = dev_get_drvdata(pdev->dev.parent);
151	struct device *dev = &pdev->dev;
152	struct clk_init_data init = {};
153	struct rk808_clkout *rk808_clkout;
154	int ret;
155
156	dev->of_node = pdev->dev.parent->of_node;
157
158	rk808_clkout = devm_kzalloc(dev,
159				    sizeof(*rk808_clkout), GFP_KERNEL);
160	if (!rk808_clkout)
161		return -ENOMEM;
162
163	rk808_clkout->regmap = dev_get_regmap(pdev->dev.parent, NULL);
164	if (!rk808_clkout->regmap)
165		return -ENODEV;
166
167	init.parent_names = NULL;
168	init.num_parents = 0;
169	init.name = "rk808-clkout1";
170	init.ops = &rk808_clkout1_ops;
171	rk808_clkout->clkout1_hw.init = &init;
172
173	/* optional override of the clockname */
174	of_property_read_string_index(dev->of_node, "clock-output-names",
175				      0, &init.name);
176
177	ret = devm_clk_hw_register(dev, &rk808_clkout->clkout1_hw);
178	if (ret)
179		return ret;
180
181	init.name = "rk808-clkout2";
182	init.ops = rkpmic_get_ops(rk808->variant);
183	rk808_clkout->clkout2_hw.init = &init;
184
185	/* optional override of the clockname */
186	of_property_read_string_index(dev->of_node, "clock-output-names",
187				      1, &init.name);
188
189	ret = devm_clk_hw_register(dev, &rk808_clkout->clkout2_hw);
190	if (ret)
191		return ret;
192
193	return devm_of_clk_add_hw_provider(&pdev->dev, of_clk_rk808_get,
194					   rk808_clkout);
195}
196
197static struct platform_driver rk808_clkout_driver = {
198	.probe = rk808_clkout_probe,
199	.driver		= {
200		.name	= "rk808-clkout",
201	},
202};
203
204module_platform_driver(rk808_clkout_driver);
205
206MODULE_DESCRIPTION("Clkout driver for the rk808 series PMICs");
207MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
208MODULE_LICENSE("GPL");
209MODULE_ALIAS("platform:rk808-clkout");
210