blob: 5807a454f3b9319c56b4a165b00b7a87f1a42d88 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0
Stephen Warren135aa952016-06-17 09:44:00 -06002/*
3 * Copyright (c) 2016, NVIDIA CORPORATION.
Stephen Warren135aa952016-06-17 09:44:00 -06004 */
5
6#include <common.h>
7#include <dm.h>
8#include <clk.h>
Simon Glass336d4612020-02-03 07:36:16 -07009#include <malloc.h>
Stephen Warren135aa952016-06-17 09:44:00 -060010#include <asm/clk.h>
Simon Glass336d4612020-02-03 07:36:16 -070011#include <dm/device_compat.h>
Simon Glass61b29b82020-02-03 07:36:15 -070012#include <linux/err.h>
Stephen Warren135aa952016-06-17 09:44:00 -060013
Stephen Warren135aa952016-06-17 09:44:00 -060014static const char * const sandbox_clk_test_names[] = {
15 [SANDBOX_CLK_TEST_ID_FIXED] = "fixed",
16 [SANDBOX_CLK_TEST_ID_SPI] = "spi",
17 [SANDBOX_CLK_TEST_ID_I2C] = "i2c",
18};
19
20int sandbox_clk_test_get(struct udevice *dev)
21{
22 struct sandbox_clk_test *sbct = dev_get_priv(dev);
23 int i, ret;
24
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +020025 for (i = 0; i < SANDBOX_CLK_TEST_NON_DEVM_COUNT; i++) {
Stephen Warren135aa952016-06-17 09:44:00 -060026 ret = clk_get_by_name(dev, sandbox_clk_test_names[i],
27 &sbct->clks[i]);
28 if (ret)
29 return ret;
30 }
31
32 return 0;
33}
34
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +020035int sandbox_clk_test_devm_get(struct udevice *dev)
36{
37 struct sandbox_clk_test *sbct = dev_get_priv(dev);
38 struct clk *clk;
39
40 clk = devm_clk_get(dev, "no-an-existing-clock");
41 if (!IS_ERR(clk)) {
42 dev_err(dev, "devm_clk_get() should have failed\n");
43 return -EINVAL;
44 }
45
46 clk = devm_clk_get(dev, "uart2");
47 if (IS_ERR(clk))
48 return PTR_ERR(clk);
49 sbct->clkps[SANDBOX_CLK_TEST_ID_DEVM1] = clk;
50
51 clk = devm_clk_get_optional(dev, "uart1");
52 if (IS_ERR(clk))
53 return PTR_ERR(clk);
54 sbct->clkps[SANDBOX_CLK_TEST_ID_DEVM2] = clk;
55
56 sbct->clkps[SANDBOX_CLK_TEST_ID_DEVM_NULL] = NULL;
57 clk = devm_clk_get_optional(dev, "not_an_existing_clock");
58 if (IS_ERR(clk))
59 return PTR_ERR(clk);
60 if (clk)
61 return -EINVAL;
62
63 return 0;
64}
65
Neil Armstrong65388d02018-04-03 11:44:19 +020066int sandbox_clk_test_get_bulk(struct udevice *dev)
67{
68 struct sandbox_clk_test *sbct = dev_get_priv(dev);
69
70 return clk_get_bulk(dev, &sbct->bulk);
71}
72
Stephen Warren135aa952016-06-17 09:44:00 -060073ulong sandbox_clk_test_get_rate(struct udevice *dev, int id)
74{
75 struct sandbox_clk_test *sbct = dev_get_priv(dev);
76
77 if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
78 return -EINVAL;
79
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +020080 return clk_get_rate(sbct->clkps[id]);
Stephen Warren135aa952016-06-17 09:44:00 -060081}
82
Dario Binacchi2983ad52020-12-30 00:06:31 +010083ulong sandbox_clk_test_round_rate(struct udevice *dev, int id, ulong rate)
84{
85 struct sandbox_clk_test *sbct = dev_get_priv(dev);
86
87 if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
88 return -EINVAL;
89
90 return clk_round_rate(sbct->clkps[id], rate);
91}
92
Stephen Warren135aa952016-06-17 09:44:00 -060093ulong sandbox_clk_test_set_rate(struct udevice *dev, int id, ulong rate)
94{
95 struct sandbox_clk_test *sbct = dev_get_priv(dev);
96
97 if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
98 return -EINVAL;
99
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200100 return clk_set_rate(sbct->clkps[id], rate);
Stephen Warren135aa952016-06-17 09:44:00 -0600101}
102
103int sandbox_clk_test_enable(struct udevice *dev, int id)
104{
105 struct sandbox_clk_test *sbct = dev_get_priv(dev);
106
107 if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
108 return -EINVAL;
109
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200110 return clk_enable(sbct->clkps[id]);
Stephen Warren135aa952016-06-17 09:44:00 -0600111}
112
Neil Armstrong65388d02018-04-03 11:44:19 +0200113int sandbox_clk_test_enable_bulk(struct udevice *dev)
114{
115 struct sandbox_clk_test *sbct = dev_get_priv(dev);
116
117 return clk_enable_bulk(&sbct->bulk);
118}
119
Stephen Warren135aa952016-06-17 09:44:00 -0600120int sandbox_clk_test_disable(struct udevice *dev, int id)
121{
122 struct sandbox_clk_test *sbct = dev_get_priv(dev);
123
124 if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
125 return -EINVAL;
126
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200127 return clk_disable(sbct->clkps[id]);
Stephen Warren135aa952016-06-17 09:44:00 -0600128}
129
Neil Armstrong65388d02018-04-03 11:44:19 +0200130int sandbox_clk_test_disable_bulk(struct udevice *dev)
131{
132 struct sandbox_clk_test *sbct = dev_get_priv(dev);
133
134 return clk_disable_bulk(&sbct->bulk);
135}
136
Stephen Warren135aa952016-06-17 09:44:00 -0600137int sandbox_clk_test_free(struct udevice *dev)
138{
139 struct sandbox_clk_test *sbct = dev_get_priv(dev);
Sean Andersonac15e782022-01-15 17:25:04 -0500140 int i;
Stephen Warren135aa952016-06-17 09:44:00 -0600141
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200142 devm_clk_put(dev, sbct->clkps[SANDBOX_CLK_TEST_ID_DEVM1]);
Sean Andersonac15e782022-01-15 17:25:04 -0500143 for (i = 0; i < SANDBOX_CLK_TEST_NON_DEVM_COUNT; i++)
144 clk_free(&sbct->clks[i]);
Stephen Warren135aa952016-06-17 09:44:00 -0600145
146 return 0;
147}
148
Neil Armstrong65388d02018-04-03 11:44:19 +0200149int sandbox_clk_test_release_bulk(struct udevice *dev)
150{
151 struct sandbox_clk_test *sbct = dev_get_priv(dev);
152
153 return clk_release_bulk(&sbct->bulk);
154}
155
Fabrice Gasnier1fe243a2018-07-24 16:31:28 +0200156int sandbox_clk_test_valid(struct udevice *dev)
157{
158 struct sandbox_clk_test *sbct = dev_get_priv(dev);
159 int i;
160
161 for (i = 0; i < SANDBOX_CLK_TEST_ID_COUNT; i++) {
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200162 if (!clk_valid(sbct->clkps[i]))
163 if (i != SANDBOX_CLK_TEST_ID_DEVM_NULL)
164 return -EINVAL;
Fabrice Gasnier1fe243a2018-07-24 16:31:28 +0200165 }
166
167 return 0;
168}
169
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200170static int sandbox_clk_test_probe(struct udevice *dev)
171{
172 struct sandbox_clk_test *sbct = dev_get_priv(dev);
173 int i;
174
175 for (i = 0; i < SANDBOX_CLK_TEST_ID_DEVM1; i++)
176 sbct->clkps[i] = &sbct->clks[i];
177 for (i = SANDBOX_CLK_TEST_ID_DEVM1; i < SANDBOX_CLK_TEST_ID_COUNT; i++)
178 sbct->clkps[i] = NULL;
179
180 return 0;
181}
182
Stephen Warren135aa952016-06-17 09:44:00 -0600183static const struct udevice_id sandbox_clk_test_ids[] = {
184 { .compatible = "sandbox,clk-test" },
185 { }
186};
187
188U_BOOT_DRIVER(sandbox_clk_test) = {
189 .name = "sandbox_clk_test",
190 .id = UCLASS_MISC,
191 .of_match = sandbox_clk_test_ids,
Jean-Jacques Hiblotdd2e0ce2019-10-22 14:00:05 +0200192 .probe = sandbox_clk_test_probe,
Simon Glass41575d82020-12-03 16:55:17 -0700193 .priv_auto = sizeof(struct sandbox_clk_test),
Stephen Warren135aa952016-06-17 09:44:00 -0600194};