1 // SPDX-License-Identifier: GPL-2.0+
2
3 #include <common.h>
4 #include <log.h>
5 #include <asm/io.h>
6 #include <clk-uclass.h>
7 #include <dm.h>
8 #include <regmap.h>
9 #include <syscon.h>
10 #include <dt-bindings/clock/axg-aoclkc.h>
11
12 #include "clk_meson.h"
13
14 struct meson_clk {
15 struct regmap *map;
16 };
17
18 #define AO_CLK_GATE0 0x40
19 #define AO_SAR_CLK 0x90
20
21 static struct meson_gate gates[] = {
22 MESON_GATE(CLKID_AO_SAR_ADC, AO_CLK_GATE0, 7),
23 MESON_GATE(CLKID_AO_SAR_ADC_CLK, AO_SAR_CLK, 7),
24 };
25
meson_set_gate(struct clk * clk,bool on)26 static int meson_set_gate(struct clk *clk, bool on)
27 {
28 struct meson_clk *priv = dev_get_priv(clk->dev);
29 struct meson_gate *gate;
30
31 gate = &gates[clk->id];
32
33 regmap_update_bits(priv->map, gate->reg,
34 BIT(gate->bit), on ? BIT(gate->bit) : 0);
35
36 return 0;
37 }
38
meson_clk_enable(struct clk * clk)39 static int meson_clk_enable(struct clk *clk)
40 {
41 return meson_set_gate(clk, true);
42 }
43
meson_clk_disable(struct clk * clk)44 static int meson_clk_disable(struct clk *clk)
45 {
46 return meson_set_gate(clk, false);
47 }
48
meson_clk_probe(struct udevice * dev)49 static int meson_clk_probe(struct udevice *dev)
50 {
51 struct meson_clk *priv = dev_get_priv(dev);
52
53 priv->map = syscon_node_to_regmap(dev_ofnode(dev_get_parent(dev)));
54 if (IS_ERR(priv->map))
55 return PTR_ERR(priv->map);
56
57 return 0;
58 }
59
meson_clk_request(struct clk * clk)60 static int meson_clk_request(struct clk *clk)
61 {
62 if (clk->id >= ARRAY_SIZE(gates))
63 return -ENOENT;
64
65 return 0;
66 }
67
68 static struct clk_ops meson_clk_ops = {
69 .disable = meson_clk_disable,
70 .enable = meson_clk_enable,
71 .request = meson_clk_request,
72 };
73
74 static const struct udevice_id meson_clk_ids[] = {
75 { .compatible = "amlogic,meson-axg-aoclkc" },
76 { }
77 };
78
79 U_BOOT_DRIVER(meson_clk_axg_ao) = {
80 .name = "meson_clk_axg_ao",
81 .id = UCLASS_CLK,
82 .of_match = meson_clk_ids,
83 .priv_auto = sizeof(struct meson_clk),
84 .ops = &meson_clk_ops,
85 .probe = meson_clk_probe,
86 };
87