Linux 4.16.11
[linux/fpc-iii.git] / drivers / clk / ux500 / clk-prcc.c
blob7cfb59c9136d4169f4fc149a87d64e47f2a19389
1 /*
2 * PRCC clock implementation for ux500 platform.
4 * Copyright (C) 2012 ST-Ericsson SA
5 * Author: Ulf Hansson <ulf.hansson@linaro.org>
7 * License terms: GNU General Public License (GPL) version 2
8 */
10 #include <linux/clk-provider.h>
11 #include <linux/slab.h>
12 #include <linux/io.h>
13 #include <linux/err.h>
14 #include <linux/types.h>
16 #include "clk.h"
18 #define PRCC_PCKEN 0x000
19 #define PRCC_PCKDIS 0x004
20 #define PRCC_KCKEN 0x008
21 #define PRCC_KCKDIS 0x00C
22 #define PRCC_PCKSR 0x010
23 #define PRCC_KCKSR 0x014
25 #define to_clk_prcc(_hw) container_of(_hw, struct clk_prcc, hw)
27 struct clk_prcc {
28 struct clk_hw hw;
29 void __iomem *base;
30 u32 cg_sel;
31 int is_enabled;
34 /* PRCC clock operations. */
36 static int clk_prcc_pclk_enable(struct clk_hw *hw)
38 struct clk_prcc *clk = to_clk_prcc(hw);
40 writel(clk->cg_sel, (clk->base + PRCC_PCKEN));
41 while (!(readl(clk->base + PRCC_PCKSR) & clk->cg_sel))
42 cpu_relax();
44 clk->is_enabled = 1;
45 return 0;
48 static void clk_prcc_pclk_disable(struct clk_hw *hw)
50 struct clk_prcc *clk = to_clk_prcc(hw);
52 writel(clk->cg_sel, (clk->base + PRCC_PCKDIS));
53 clk->is_enabled = 0;
56 static int clk_prcc_kclk_enable(struct clk_hw *hw)
58 struct clk_prcc *clk = to_clk_prcc(hw);
60 writel(clk->cg_sel, (clk->base + PRCC_KCKEN));
61 while (!(readl(clk->base + PRCC_KCKSR) & clk->cg_sel))
62 cpu_relax();
64 clk->is_enabled = 1;
65 return 0;
68 static void clk_prcc_kclk_disable(struct clk_hw *hw)
70 struct clk_prcc *clk = to_clk_prcc(hw);
72 writel(clk->cg_sel, (clk->base + PRCC_KCKDIS));
73 clk->is_enabled = 0;
76 static int clk_prcc_is_enabled(struct clk_hw *hw)
78 struct clk_prcc *clk = to_clk_prcc(hw);
79 return clk->is_enabled;
82 static const struct clk_ops clk_prcc_pclk_ops = {
83 .enable = clk_prcc_pclk_enable,
84 .disable = clk_prcc_pclk_disable,
85 .is_enabled = clk_prcc_is_enabled,
88 static const struct clk_ops clk_prcc_kclk_ops = {
89 .enable = clk_prcc_kclk_enable,
90 .disable = clk_prcc_kclk_disable,
91 .is_enabled = clk_prcc_is_enabled,
94 static struct clk *clk_reg_prcc(const char *name,
95 const char *parent_name,
96 resource_size_t phy_base,
97 u32 cg_sel,
98 unsigned long flags,
99 const struct clk_ops *clk_prcc_ops)
101 struct clk_prcc *clk;
102 struct clk_init_data clk_prcc_init;
103 struct clk *clk_reg;
105 if (!name) {
106 pr_err("clk_prcc: %s invalid arguments passed\n", __func__);
107 return ERR_PTR(-EINVAL);
110 clk = kzalloc(sizeof(*clk), GFP_KERNEL);
111 if (!clk)
112 return ERR_PTR(-ENOMEM);
114 clk->base = ioremap(phy_base, SZ_4K);
115 if (!clk->base)
116 goto free_clk;
118 clk->cg_sel = cg_sel;
119 clk->is_enabled = 1;
121 clk_prcc_init.name = name;
122 clk_prcc_init.ops = clk_prcc_ops;
123 clk_prcc_init.flags = flags;
124 clk_prcc_init.parent_names = (parent_name ? &parent_name : NULL);
125 clk_prcc_init.num_parents = (parent_name ? 1 : 0);
126 clk->hw.init = &clk_prcc_init;
128 clk_reg = clk_register(NULL, &clk->hw);
129 if (IS_ERR_OR_NULL(clk_reg))
130 goto unmap_clk;
132 return clk_reg;
134 unmap_clk:
135 iounmap(clk->base);
136 free_clk:
137 kfree(clk);
138 pr_err("clk_prcc: %s failed to register clk\n", __func__);
139 return ERR_PTR(-ENOMEM);
142 struct clk *clk_reg_prcc_pclk(const char *name,
143 const char *parent_name,
144 resource_size_t phy_base,
145 u32 cg_sel,
146 unsigned long flags)
148 return clk_reg_prcc(name, parent_name, phy_base, cg_sel, flags,
149 &clk_prcc_pclk_ops);
152 struct clk *clk_reg_prcc_kclk(const char *name,
153 const char *parent_name,
154 resource_size_t phy_base,
155 u32 cg_sel,
156 unsigned long flags)
158 return clk_reg_prcc(name, parent_name, phy_base, cg_sel, flags,
159 &clk_prcc_kclk_ops);