1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * (C) Copyright 2015 Google, Inc
4 */
5
6 #include <common.h>
7 #include <clk-uclass.h>
8 #include <dm.h>
9 #include <errno.h>
10 #include <asm/clk.h>
11
12 struct sandbox_clk_priv {
13 ulong rate[SANDBOX_CLK_ID_COUNT];
14 bool enabled[SANDBOX_CLK_ID_COUNT];
15 };
16
sandbox_clk_get_rate(struct clk * clk)17 static ulong sandbox_clk_get_rate(struct clk *clk)
18 {
19 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
20
21 if (clk->id >= SANDBOX_CLK_ID_COUNT)
22 return -EINVAL;
23
24 return priv->rate[clk->id];
25 }
26
sandbox_clk_set_rate(struct clk * clk,ulong rate)27 static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
28 {
29 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
30 ulong old_rate;
31
32 if (clk->id >= SANDBOX_CLK_ID_COUNT)
33 return -EINVAL;
34
35 if (!rate)
36 return -EINVAL;
37
38 old_rate = priv->rate[clk->id];
39 priv->rate[clk->id] = rate;
40
41 return old_rate;
42 }
43
sandbox_clk_enable(struct clk * clk)44 static int sandbox_clk_enable(struct clk *clk)
45 {
46 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
47
48 if (clk->id >= SANDBOX_CLK_ID_COUNT)
49 return -EINVAL;
50
51 priv->enabled[clk->id] = true;
52
53 return 0;
54 }
55
sandbox_clk_disable(struct clk * clk)56 static int sandbox_clk_disable(struct clk *clk)
57 {
58 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
59
60 if (clk->id >= SANDBOX_CLK_ID_COUNT)
61 return -EINVAL;
62
63 priv->enabled[clk->id] = false;
64
65 return 0;
66 }
67
68 static struct clk_ops sandbox_clk_ops = {
69 .get_rate = sandbox_clk_get_rate,
70 .set_rate = sandbox_clk_set_rate,
71 .enable = sandbox_clk_enable,
72 .disable = sandbox_clk_disable,
73 };
74
75 static const struct udevice_id sandbox_clk_ids[] = {
76 { .compatible = "sandbox,clk" },
77 { }
78 };
79
80 U_BOOT_DRIVER(clk_sandbox) = {
81 .name = "clk_sandbox",
82 .id = UCLASS_CLK,
83 .of_match = sandbox_clk_ids,
84 .ops = &sandbox_clk_ops,
85 .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv),
86 };
87
sandbox_clk_query_rate(struct udevice * dev,int id)88 ulong sandbox_clk_query_rate(struct udevice *dev, int id)
89 {
90 struct sandbox_clk_priv *priv = dev_get_priv(dev);
91
92 if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
93 return -EINVAL;
94
95 return priv->rate[id];
96 }
97
sandbox_clk_query_enable(struct udevice * dev,int id)98 int sandbox_clk_query_enable(struct udevice *dev, int id)
99 {
100 struct sandbox_clk_priv *priv = dev_get_priv(dev);
101
102 if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
103 return -EINVAL;
104
105 return priv->enabled[id];
106 }
107