1#include <linux/io.h>
  2#include <linux/clk-provider.h>
  3#include <linux/slab.h>
  4#include <linux/of.h>
  5#include <linux/of_address.h>
  6
  7#include "clk.h"
  8
  9void mmp_clk_init(struct device_node *np, struct mmp_clk_unit *unit,
 10		int nr_clks)
 11{
 12	static struct clk **clk_table;
 13
 14	clk_table = kcalloc(nr_clks, sizeof(struct clk *), GFP_KERNEL);
 15	if (!clk_table)
 16		return;
 17
 18	unit->clk_table = clk_table;
 19	unit->nr_clks = nr_clks;
 20	unit->clk_data.clks = clk_table;
 21	unit->clk_data.clk_num = nr_clks;
 22	of_clk_add_provider(np, of_clk_src_onecell_get, &unit->clk_data);
 23}
 24
 25void mmp_register_fixed_rate_clks(struct mmp_clk_unit *unit,
 26				struct mmp_param_fixed_rate_clk *clks,
 27				int size)
 28{
 29	int i;
 30	struct clk *clk;
 31
 32	for (i = 0; i < size; i++) {
 33		clk = clk_register_fixed_rate(NULL, clks[i].name,
 34					clks[i].parent_name,
 35					clks[i].flags,
 36					clks[i].fixed_rate);
 37		if (IS_ERR(clk)) {
 38			pr_err("%s: failed to register clock %s\n",
 39			       __func__, clks[i].name);
 40			continue;
 41		}
 42		if (clks[i].id)
 43			unit->clk_table[clks[i].id] = clk;
 44	}
 45}
 46
 47void mmp_register_fixed_factor_clks(struct mmp_clk_unit *unit,
 48				struct mmp_param_fixed_factor_clk *clks,
 49				int size)
 50{
 51	struct clk *clk;
 52	int i;
 53
 54	for (i = 0; i < size; i++) {
 55		clk = clk_register_fixed_factor(NULL, clks[i].name,
 56						clks[i].parent_name,
 57						clks[i].flags, clks[i].mult,
 58						clks[i].div);
 59		if (IS_ERR(clk)) {
 60			pr_err("%s: failed to register clock %s\n",
 61			       __func__, clks[i].name);
 62			continue;
 63		}
 64		if (clks[i].id)
 65			unit->clk_table[clks[i].id] = clk;
 66	}
 67}
 68
 69void mmp_register_general_gate_clks(struct mmp_clk_unit *unit,
 70				struct mmp_param_general_gate_clk *clks,
 71				void __iomem *base, int size)
 72{
 73	struct clk *clk;
 74	int i;
 75
 76	for (i = 0; i < size; i++) {
 77		clk = clk_register_gate(NULL, clks[i].name,
 78					clks[i].parent_name,
 79					clks[i].flags,
 80					base + clks[i].offset,
 81					clks[i].bit_idx,
 82					clks[i].gate_flags,
 83					clks[i].lock);
 84
 85		if (IS_ERR(clk)) {
 86			pr_err("%s: failed to register clock %s\n",
 87			       __func__, clks[i].name);
 88			continue;
 89		}
 90		if (clks[i].id)
 91			unit->clk_table[clks[i].id] = clk;
 92	}
 93}
 94
 95void mmp_register_gate_clks(struct mmp_clk_unit *unit,
 96			struct mmp_param_gate_clk *clks,
 97			void __iomem *base, int size)
 98{
 99	struct clk *clk;
100	int i;
101
102	for (i = 0; i < size; i++) {
103		clk = mmp_clk_register_gate(NULL, clks[i].name,
104					clks[i].parent_name,
105					clks[i].flags,
106					base + clks[i].offset,
107					clks[i].mask,
108					clks[i].val_enable,
109					clks[i].val_disable,
110					clks[i].gate_flags,
111					clks[i].lock);
112
113		if (IS_ERR(clk)) {
114			pr_err("%s: failed to register clock %s\n",
115			       __func__, clks[i].name);
116			continue;
117		}
118		if (clks[i].id)
119			unit->clk_table[clks[i].id] = clk;
120	}
121}
122
123void mmp_register_mux_clks(struct mmp_clk_unit *unit,
124			struct mmp_param_mux_clk *clks,
125			void __iomem *base, int size)
126{
127	struct clk *clk;
128	int i;
129
130	for (i = 0; i < size; i++) {
131		clk = clk_register_mux(NULL, clks[i].name,
132					clks[i].parent_name,
133					clks[i].num_parents,
134					clks[i].flags,
135					base + clks[i].offset,
136					clks[i].shift,
137					clks[i].width,
138					clks[i].mux_flags,
139					clks[i].lock);
140
141		if (IS_ERR(clk)) {
142			pr_err("%s: failed to register clock %s\n",
143			       __func__, clks[i].name);
144			continue;
145		}
146		if (clks[i].id)
147			unit->clk_table[clks[i].id] = clk;
148	}
149}
150
151void mmp_register_div_clks(struct mmp_clk_unit *unit,
152			struct mmp_param_div_clk *clks,
153			void __iomem *base, int size)
154{
155	struct clk *clk;
156	int i;
157
158	for (i = 0; i < size; i++) {
159		clk = clk_register_divider(NULL, clks[i].name,
160					clks[i].parent_name,
161					clks[i].flags,
162					base + clks[i].offset,
163					clks[i].shift,
164					clks[i].width,
165					clks[i].div_flags,
166					clks[i].lock);
167
168		if (IS_ERR(clk)) {
169			pr_err("%s: failed to register clock %s\n",
170			       __func__, clks[i].name);
171			continue;
172		}
173		if (clks[i].id)
174			unit->clk_table[clks[i].id] = clk;
175	}
176}
177
178void mmp_clk_add(struct mmp_clk_unit *unit, unsigned int id,
179			struct clk *clk)
180{
181	if (IS_ERR_OR_NULL(clk)) {
182		pr_err("CLK %d has invalid pointer %p\n", id, clk);
183		return;
184	}
185	if (id > unit->nr_clks) {
186		pr_err("CLK %d is invalid\n", id);
187		return;
188	}
189
190	unit->clk_table[id] = clk;
191}