1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2018 Amarula Solutions.
4 * Author: Jagan Teki <jagan@amarulasolutions.com>
8 #include <clk-uclass.h>
12 #include <asm/arch/ccu.h>
13 #include <linux/log2.h>
15 static const struct ccu_clk_gate *priv_to_gate(struct ccu_priv *priv,
18 return &priv->desc->gates[id];
21 static int sunxi_set_gate(struct clk *clk, bool on)
23 struct ccu_priv *priv = dev_get_priv(clk->dev);
24 const struct ccu_clk_gate *gate = priv_to_gate(priv, clk->id);
27 if (!(gate->flags & CCU_CLK_F_IS_VALID)) {
28 printf("%s: (CLK#%ld) unhandled\n", __func__, clk->id);
32 debug("%s: (CLK#%ld) off#0x%x, BIT(%d)\n", __func__,
33 clk->id, gate->off, ilog2(gate->bit));
35 reg = readl(priv->base + gate->off);
41 writel(reg, priv->base + gate->off);
46 static int sunxi_clk_enable(struct clk *clk)
48 return sunxi_set_gate(clk, true);
51 static int sunxi_clk_disable(struct clk *clk)
53 return sunxi_set_gate(clk, false);
56 struct clk_ops sunxi_clk_ops = {
57 .enable = sunxi_clk_enable,
58 .disable = sunxi_clk_disable,
61 int sunxi_clk_probe(struct udevice *dev)
63 struct ccu_priv *priv = dev_get_priv(dev);
65 priv->base = dev_read_addr_ptr(dev);
69 priv->desc = (const struct ccu_desc *)dev_get_driver_data(dev);