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
mmp_clk_init(struct device_node * np,struct mmp_clk_unit * unit,int nr_clks)9 void 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
mmp_register_fixed_rate_clks(struct mmp_clk_unit * unit,struct mmp_param_fixed_rate_clk * clks,int size)25 void 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
mmp_register_fixed_factor_clks(struct mmp_clk_unit * unit,struct mmp_param_fixed_factor_clk * clks,int size)47 void 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
mmp_register_general_gate_clks(struct mmp_clk_unit * unit,struct mmp_param_general_gate_clk * clks,void __iomem * base,int size)69 void 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
mmp_register_gate_clks(struct mmp_clk_unit * unit,struct mmp_param_gate_clk * clks,void __iomem * base,int size)95 void 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
mmp_register_mux_clks(struct mmp_clk_unit * unit,struct mmp_param_mux_clk * clks,void __iomem * base,int size)123 void 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
mmp_register_div_clks(struct mmp_clk_unit * unit,struct mmp_param_div_clk * clks,void __iomem * base,int size)151 void 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
mmp_clk_add(struct mmp_clk_unit * unit,unsigned int id,struct clk * clk)178 void 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 }
192