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