1 // SPDX-License-Identifier: GPL-2.0
3 * (C) Copyright 2015 Google, Inc
7 #include <clk-uclass.h>
12 struct sandbox_clk_priv {
14 ulong rate[SANDBOX_CLK_ID_COUNT];
15 bool enabled[SANDBOX_CLK_ID_COUNT];
16 bool requested[SANDBOX_CLK_ID_COUNT];
19 static ulong sandbox_clk_get_rate(struct clk *clk)
21 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
26 if (clk->id >= SANDBOX_CLK_ID_COUNT)
29 return priv->rate[clk->id];
32 static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
34 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
40 if (clk->id >= SANDBOX_CLK_ID_COUNT)
46 old_rate = priv->rate[clk->id];
47 priv->rate[clk->id] = rate;
52 static int sandbox_clk_enable(struct clk *clk)
54 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
59 if (clk->id >= SANDBOX_CLK_ID_COUNT)
62 priv->enabled[clk->id] = true;
67 static int sandbox_clk_disable(struct clk *clk)
69 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
74 if (clk->id >= SANDBOX_CLK_ID_COUNT)
77 priv->enabled[clk->id] = false;
82 static int sandbox_clk_request(struct clk *clk)
84 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
86 if (clk->id >= SANDBOX_CLK_ID_COUNT)
89 priv->requested[clk->id] = true;
93 static int sandbox_clk_free(struct clk *clk)
95 struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
97 if (clk->id >= SANDBOX_CLK_ID_COUNT)
100 priv->requested[clk->id] = false;
104 static struct clk_ops sandbox_clk_ops = {
105 .get_rate = sandbox_clk_get_rate,
106 .set_rate = sandbox_clk_set_rate,
107 .enable = sandbox_clk_enable,
108 .disable = sandbox_clk_disable,
109 .request = sandbox_clk_request,
110 .free = sandbox_clk_free,
113 static int sandbox_clk_probe(struct udevice *dev)
115 struct sandbox_clk_priv *priv = dev_get_priv(dev);
121 static const struct udevice_id sandbox_clk_ids[] = {
122 { .compatible = "sandbox,clk" },
126 U_BOOT_DRIVER(clk_sandbox) = {
127 .name = "clk_sandbox",
129 .of_match = sandbox_clk_ids,
130 .ops = &sandbox_clk_ops,
131 .probe = sandbox_clk_probe,
132 .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv),
135 ulong sandbox_clk_query_rate(struct udevice *dev, int id)
137 struct sandbox_clk_priv *priv = dev_get_priv(dev);
139 if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
142 return priv->rate[id];
145 int sandbox_clk_query_enable(struct udevice *dev, int id)
147 struct sandbox_clk_priv *priv = dev_get_priv(dev);
149 if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
152 return priv->enabled[id];
155 int sandbox_clk_query_requested(struct udevice *dev, int id)
157 struct sandbox_clk_priv *priv = dev_get_priv(dev);
159 if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
161 return priv->requested[id];