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