exynos5422_clock.c revision 1.2 1 1.2 jmcneill /* $NetBSD: exynos5422_clock.c,v 1.2 2015/12/05 18:29:22 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include "locators.h"
30 1.1 jmcneill
31 1.1 jmcneill #include <sys/cdefs.h>
32 1.2 jmcneill __KERNEL_RCSID(0, "$NetBSD: exynos5422_clock.c,v 1.2 2015/12/05 18:29:22 jmcneill Exp $");
33 1.1 jmcneill
34 1.1 jmcneill #include <sys/param.h>
35 1.1 jmcneill #include <sys/bus.h>
36 1.1 jmcneill #include <sys/device.h>
37 1.1 jmcneill #include <sys/intr.h>
38 1.1 jmcneill #include <sys/systm.h>
39 1.1 jmcneill #include <sys/kernel.h>
40 1.1 jmcneill #include <sys/atomic.h>
41 1.1 jmcneill
42 1.1 jmcneill #include <dev/clk/clk_backend.h>
43 1.1 jmcneill
44 1.1 jmcneill #include <arm/samsung/exynos_reg.h>
45 1.1 jmcneill #include <arm/samsung/exynos_var.h>
46 1.1 jmcneill #include <arm/samsung/exynos_clock.h>
47 1.1 jmcneill
48 1.1 jmcneill static struct clk *exynos5422_clock_get(void *, const char *);
49 1.1 jmcneill static void exynos5422_clock_put(void *, struct clk *);
50 1.1 jmcneill static u_int exynos5422_clock_get_rate(void *, struct clk *);
51 1.1 jmcneill static int exynos5422_clock_set_rate(void *, struct clk *, u_int);
52 1.1 jmcneill static int exynos5422_clock_enable(void *, struct clk *);
53 1.1 jmcneill static int exynos5422_clock_disable(void *, struct clk *);
54 1.1 jmcneill static int exynos5422_clock_set_parent(void *, struct clk *, struct clk *);
55 1.1 jmcneill static struct clk *exynos5422_clock_get_parent(void *, struct clk *);
56 1.1 jmcneill
57 1.1 jmcneill static const struct clk_funcs exynos5422_clock_funcs = {
58 1.1 jmcneill .get = exynos5422_clock_get,
59 1.1 jmcneill .put = exynos5422_clock_put,
60 1.1 jmcneill .get_rate = exynos5422_clock_get_rate,
61 1.1 jmcneill .set_rate = exynos5422_clock_set_rate,
62 1.1 jmcneill .enable = exynos5422_clock_enable,
63 1.1 jmcneill .disable = exynos5422_clock_disable,
64 1.1 jmcneill .set_parent = exynos5422_clock_set_parent,
65 1.1 jmcneill .get_parent = exynos5422_clock_get_parent,
66 1.1 jmcneill };
67 1.1 jmcneill
68 1.1 jmcneill #define CLK_FIXED(_name, _rate) { \
69 1.1 jmcneill .base = { .name = (_name) }, .type = EXYNOS_CLK_FIXED, \
70 1.1 jmcneill .u = { .fixed = { .rate = (_rate) } } \
71 1.1 jmcneill }
72 1.1 jmcneill
73 1.1 jmcneill #define CLK_PLL(_name, _parent, _base) { \
74 1.1 jmcneill .base = { .name = (_name) }, .type = EXYNOS_CLK_PLL, \
75 1.1 jmcneill .parent = (_parent), \
76 1.1 jmcneill .u = { \
77 1.1 jmcneill .pll = { \
78 1.1 jmcneill .con0_reg = (_base) + PLL_CON0_OFFSET, \
79 1.1 jmcneill .lock_reg = (_base) + PLL_LOCK_OFFSET, \
80 1.1 jmcneill } \
81 1.1 jmcneill } \
82 1.1 jmcneill }
83 1.1 jmcneill
84 1.1 jmcneill #define CLK_MUXF(_name, _alias, _reg, _bits, _f, _p) { \
85 1.1 jmcneill .base = { .name = (_name), .flags = (_f) }, \
86 1.1 jmcneill .type = EXYNOS_CLK_MUX, \
87 1.1 jmcneill .alias = (_alias), \
88 1.1 jmcneill .u = { \
89 1.1 jmcneill .mux = { \
90 1.1 jmcneill .nparents = __arraycount(_p), \
91 1.1 jmcneill .parents = (_p), \
92 1.1 jmcneill .reg = (_reg), \
93 1.1 jmcneill .bits = (_bits) \
94 1.1 jmcneill } \
95 1.1 jmcneill } \
96 1.1 jmcneill }
97 1.1 jmcneill
98 1.1 jmcneill #define CLK_MUXA(_name, _alias, _reg, _bits, _p) \
99 1.1 jmcneill CLK_MUXF(_name, _alias, _reg, _bits, 0, _p)
100 1.1 jmcneill
101 1.1 jmcneill #define CLK_MUX(_name, _reg, _bits, _p) \
102 1.1 jmcneill CLK_MUXF(_name, NULL, _reg, _bits, 0, _p)
103 1.1 jmcneill
104 1.1 jmcneill #define CLK_DIV(_name, _parent, _reg, _bits) { \
105 1.1 jmcneill .base = { .name = (_name) }, .type = EXYNOS_CLK_DIV, \
106 1.1 jmcneill .parent = (_parent), \
107 1.1 jmcneill .u = { \
108 1.1 jmcneill .div = { \
109 1.1 jmcneill .reg = (_reg), \
110 1.1 jmcneill .bits = (_bits) \
111 1.1 jmcneill } \
112 1.1 jmcneill } \
113 1.1 jmcneill }
114 1.1 jmcneill
115 1.1 jmcneill #define CLK_GATE(_name, _parent, _reg, _bits, _f) { \
116 1.1 jmcneill .base = { .name = (_name), .flags = (_f) }, \
117 1.1 jmcneill .type = EXYNOS_CLK_GATE, \
118 1.1 jmcneill .parent = (_parent), \
119 1.1 jmcneill .u = { \
120 1.1 jmcneill .gate = { \
121 1.1 jmcneill .reg = (_reg), \
122 1.1 jmcneill .bits = (_bits) \
123 1.1 jmcneill } \
124 1.1 jmcneill } \
125 1.1 jmcneill }
126 1.1 jmcneill
127 1.1 jmcneill #define EXYNOS5422_APLL_BASE 0x00000
128 1.1 jmcneill #define EXYNOS5422_CPLL_BASE 0x10020
129 1.1 jmcneill #define EXYNOS5422_DPLL_BASE 0x10030
130 1.1 jmcneill #define EXYNOS5422_EPLL_BASE 0x10040
131 1.1 jmcneill #define EXYNOS5422_RPLL_BASE 0x10050
132 1.1 jmcneill #define EXYNOS5422_IPLL_BASE 0x10060
133 1.1 jmcneill #define EXYNOS5422_SPLL_BASE 0x10070
134 1.1 jmcneill #define EXYNOS5422_VPLL_BASE 0x10080
135 1.1 jmcneill #define EXYNOS5422_MPLL_BASE 0x10090
136 1.1 jmcneill #define EXYNOS5422_BPLL_BASE 0x20010
137 1.1 jmcneill #define EXYNOS5422_KPLL_BASE 0x28000
138 1.1 jmcneill
139 1.1 jmcneill #define EXYNOS5422_SRC_CPU 0x00200
140 1.1 jmcneill #define EXYNOS5422_SRC_TOP0 0x10200
141 1.1 jmcneill #define EXYNOS5422_SRC_TOP1 0x10204
142 1.1 jmcneill #define EXYNOS5422_SRC_TOP2 0x10208
143 1.1 jmcneill #define EXYNOS5422_SRC_TOP3 0x1020c
144 1.1 jmcneill #define EXYNOS5422_SRC_TOP4 0x10210
145 1.1 jmcneill #define EXYNOS5422_SRC_TOP5 0x10214
146 1.1 jmcneill #define EXYNOS5422_SRC_TOP6 0x10218
147 1.1 jmcneill #define EXYNOS5422_SRC_TOP7 0x1021c
148 1.1 jmcneill #define EXYNOS5422_SRC_DISP10 0x1022c
149 1.1 jmcneill #define EXYNOS5422_SRC_MAU 0x10240
150 1.1 jmcneill #define EXYNOS5422_SRC_FSYS 0x10244
151 1.1 jmcneill #define EXYNOS5422_SRC_PERIC0 0x10250
152 1.1 jmcneill #define EXYNOS5422_SRC_PERIC1 0x10254
153 1.1 jmcneill #define EXYNOS5422_SRC_ISP 0x10270
154 1.1 jmcneill #define EXYNOS5422_SRC_TOP10 0x10280
155 1.1 jmcneill #define EXYNOS5422_SRC_TOP11 0x10280
156 1.1 jmcneill #define EXYNOS5422_SRC_TOP12 0x10280
157 1.1 jmcneill
158 1.1 jmcneill #define EXYNOS5422_DIV_FSYS1 0x1054c
159 1.1 jmcneill
160 1.1 jmcneill #define EXYNOS5422_GATE_TOP_SCLK_FSYS 0x10840
161 1.1 jmcneill
162 1.1 jmcneill static const char *mout_cpll_p[] = { "fin_pll", "fout_cpll" };
163 1.1 jmcneill static const char *mout_dpll_p[] = { "fin_pll", "fout_dpll" };
164 1.1 jmcneill static const char *mout_mpll_p[] = { "fin_pll", "fout_mpll" };
165 1.1 jmcneill static const char *mout_spll_p[] = { "fin_pll", "fout_spll" };
166 1.1 jmcneill static const char *mout_ipll_p[] = { "fin_pll", "fout_ipll" };
167 1.1 jmcneill static const char *mout_epll_p[] = { "fin_pll", "fout_epll" };
168 1.1 jmcneill static const char *mout_rpll_p[] = { "fin_pll", "fout_rpll" };
169 1.1 jmcneill static const char *mout_group2_p[] =
170 1.1 jmcneill { "fin_pll", "sclk_cpll", "sclk_dpll", "sclk_mpll",
171 1.1 jmcneill "sclk_spll", "sclk_ipll", "sclk_epll", "sclk_rpll" };
172 1.1 jmcneill
173 1.1 jmcneill static struct exynos_clk exynos5422_clocks[] = {
174 1.1 jmcneill CLK_FIXED("fin_pll", EXYNOS_F_IN_FREQ),
175 1.1 jmcneill
176 1.1 jmcneill CLK_PLL("fout_apll", "fin_pll", EXYNOS5422_APLL_BASE),
177 1.1 jmcneill CLK_PLL("fout_cpll", "fin_pll", EXYNOS5422_CPLL_BASE),
178 1.1 jmcneill CLK_PLL("fout_dpll", "fin_pll", EXYNOS5422_DPLL_BASE),
179 1.1 jmcneill CLK_PLL("fout_epll", "fin_pll", EXYNOS5422_EPLL_BASE),
180 1.1 jmcneill CLK_PLL("fout_rpll", "fin_pll", EXYNOS5422_RPLL_BASE),
181 1.1 jmcneill CLK_PLL("fout_ipll", "fin_pll", EXYNOS5422_IPLL_BASE),
182 1.1 jmcneill CLK_PLL("fout_spll", "fin_pll", EXYNOS5422_SPLL_BASE),
183 1.1 jmcneill CLK_PLL("fout_vpll", "fin_pll", EXYNOS5422_VPLL_BASE),
184 1.1 jmcneill CLK_PLL("fout_mpll", "fin_pll", EXYNOS5422_MPLL_BASE),
185 1.1 jmcneill CLK_PLL("fout_bpll", "fin_pll", EXYNOS5422_BPLL_BASE),
186 1.1 jmcneill CLK_PLL("fout_kpll", "fin_pll", EXYNOS5422_KPLL_BASE),
187 1.1 jmcneill
188 1.1 jmcneill CLK_MUXA("sclk_cpll", "mout_cpll", EXYNOS5422_SRC_TOP6, __BIT(28),
189 1.1 jmcneill mout_cpll_p),
190 1.1 jmcneill CLK_MUXA("sclk_dpll", "mout_dpll", EXYNOS5422_SRC_TOP6, __BIT(24),
191 1.1 jmcneill mout_dpll_p),
192 1.1 jmcneill CLK_MUXA("sclk_mpll", "mout_mpll", EXYNOS5422_SRC_TOP6, __BIT(0),
193 1.1 jmcneill mout_mpll_p),
194 1.1 jmcneill CLK_MUXA("sclk_spll", "mout_spll", EXYNOS5422_SRC_TOP6, __BIT(8),
195 1.1 jmcneill mout_spll_p),
196 1.1 jmcneill CLK_MUXA("sclk_ipll", "mout_ipll", EXYNOS5422_SRC_TOP6, __BIT(12),
197 1.1 jmcneill mout_ipll_p),
198 1.1 jmcneill CLK_MUXF("sclk_epll", "mout_epll", EXYNOS5422_SRC_TOP6, __BIT(20),
199 1.1 jmcneill CLK_SET_RATE_PARENT, mout_epll_p),
200 1.1 jmcneill CLK_MUXF("sclk_rpll", "mout_rpll", EXYNOS5422_SRC_TOP6, __BIT(16),
201 1.1 jmcneill CLK_SET_RATE_PARENT, mout_rpll_p),
202 1.1 jmcneill
203 1.1 jmcneill CLK_MUX("mout_mmc0", EXYNOS5422_SRC_FSYS, __BITS(10,8),
204 1.1 jmcneill mout_group2_p),
205 1.1 jmcneill CLK_MUX("mout_mmc1", EXYNOS5422_SRC_FSYS, __BITS(14,12),
206 1.1 jmcneill mout_group2_p),
207 1.1 jmcneill CLK_MUX("mout_mmc2", EXYNOS5422_SRC_FSYS, __BITS(18,16),
208 1.1 jmcneill mout_group2_p),
209 1.1 jmcneill
210 1.1 jmcneill CLK_DIV("dout_mmc0", "mout_mmc0", EXYNOS5422_DIV_FSYS1, __BITS(9,0)),
211 1.1 jmcneill CLK_DIV("dout_mmc1", "mout_mmc1", EXYNOS5422_DIV_FSYS1, __BITS(19,10)),
212 1.1 jmcneill CLK_DIV("dout_mmc2", "mout_mmc2", EXYNOS5422_DIV_FSYS1, __BITS(29,20)),
213 1.1 jmcneill
214 1.1 jmcneill CLK_GATE("sclk_mmc0", "dout_mmc0", EXYNOS5422_GATE_TOP_SCLK_FSYS,
215 1.1 jmcneill __BIT(0), CLK_SET_RATE_PARENT),
216 1.1 jmcneill CLK_GATE("sclk_mmc1", "dout_mmc1", EXYNOS5422_GATE_TOP_SCLK_FSYS,
217 1.1 jmcneill __BIT(1), CLK_SET_RATE_PARENT),
218 1.1 jmcneill CLK_GATE("sclk_mmc2", "dout_mmc2", EXYNOS5422_GATE_TOP_SCLK_FSYS,
219 1.1 jmcneill __BIT(2), CLK_SET_RATE_PARENT),
220 1.1 jmcneill };
221 1.1 jmcneill
222 1.1 jmcneill static int exynos5422_clock_match(device_t, cfdata_t, void *);
223 1.1 jmcneill static void exynos5422_clock_attach(device_t, device_t, void *);
224 1.1 jmcneill
225 1.1 jmcneill struct exynos5422_clock_softc {
226 1.1 jmcneill device_t sc_dev;
227 1.1 jmcneill bus_space_tag_t sc_bst;
228 1.1 jmcneill bus_space_handle_t sc_bsh;
229 1.1 jmcneill };
230 1.1 jmcneill
231 1.1 jmcneill static void exynos5422_clock_print_header(void);
232 1.1 jmcneill static void exynos5422_clock_print(struct exynos5422_clock_softc *,
233 1.1 jmcneill struct exynos_clk *);
234 1.1 jmcneill
235 1.1 jmcneill CFATTACH_DECL_NEW(exynos5422_clock, sizeof(struct exynos5422_clock_softc),
236 1.1 jmcneill exynos5422_clock_match, exynos5422_clock_attach, NULL, NULL);
237 1.1 jmcneill
238 1.1 jmcneill #define CLOCK_READ(sc, reg) \
239 1.1 jmcneill bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
240 1.1 jmcneill #define CLOCK_WRITE(sc, reg, val) \
241 1.1 jmcneill bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
242 1.1 jmcneill
243 1.1 jmcneill static int
244 1.1 jmcneill exynos5422_clock_match(device_t parent, cfdata_t cf, void *aux)
245 1.1 jmcneill {
246 1.1 jmcneill return IS_EXYNOS5422_P();
247 1.1 jmcneill }
248 1.1 jmcneill
249 1.1 jmcneill static void
250 1.1 jmcneill exynos5422_clock_attach(device_t parent, device_t self, void *aux)
251 1.1 jmcneill {
252 1.1 jmcneill struct exynos5422_clock_softc * const sc = device_private(self);
253 1.1 jmcneill struct exyo_attach_args * const exyo = aux;
254 1.1 jmcneill const struct exyo_locators *loc = &exyo->exyo_loc;
255 1.1 jmcneill
256 1.1 jmcneill sc->sc_dev = self;
257 1.1 jmcneill sc->sc_bst = exyo->exyo_core_bst;
258 1.1 jmcneill bus_space_subregion(exyo->exyo_core_bst, exyo->exyo_core_bsh,
259 1.1 jmcneill loc->loc_offset, loc->loc_size, &sc->sc_bsh);
260 1.1 jmcneill
261 1.1 jmcneill aprint_naive("\n");
262 1.1 jmcneill aprint_normal(": Exynos5422 Clock Controller\n");
263 1.1 jmcneill
264 1.1 jmcneill clk_backend_register("exynos5422", &exynos5422_clock_funcs, sc);
265 1.1 jmcneill
266 1.1 jmcneill exynos5422_clock_print_header();
267 1.1 jmcneill for (u_int n = 0; n < __arraycount(exynos5422_clocks); n++) {
268 1.1 jmcneill exynos5422_clock_print(sc, &exynos5422_clocks[n]);
269 1.1 jmcneill }
270 1.1 jmcneill }
271 1.1 jmcneill
272 1.1 jmcneill static struct exynos_clk *
273 1.1 jmcneill exynos5422_clock_find(const char *name)
274 1.1 jmcneill {
275 1.1 jmcneill u_int n;
276 1.1 jmcneill
277 1.1 jmcneill for (n = 0; n < __arraycount(exynos5422_clocks); n++) {
278 1.1 jmcneill if (strcmp(exynos5422_clocks[n].base.name, name) == 0) {
279 1.1 jmcneill return &exynos5422_clocks[n];
280 1.1 jmcneill }
281 1.1 jmcneill }
282 1.1 jmcneill
283 1.1 jmcneill return NULL;
284 1.1 jmcneill }
285 1.1 jmcneill
286 1.1 jmcneill static void
287 1.1 jmcneill exynos5422_clock_print_header(void)
288 1.1 jmcneill {
289 1.1 jmcneill printf(" %-10s %2s %-10s %-5s %10s\n",
290 1.1 jmcneill "clock", "", "parent", "type", "rate");
291 1.1 jmcneill printf(" %-10s %2s %-10s %-5s %10s\n",
292 1.1 jmcneill "=====", "", "======", "====", "====");
293 1.1 jmcneill }
294 1.1 jmcneill
295 1.1 jmcneill static void
296 1.1 jmcneill exynos5422_clock_print(struct exynos5422_clock_softc *sc,
297 1.1 jmcneill struct exynos_clk *eclk)
298 1.1 jmcneill {
299 1.1 jmcneill struct exynos_clk *eclk_parent;
300 1.1 jmcneill struct clk *clk_parent;
301 1.1 jmcneill const char *type = "?";
302 1.1 jmcneill
303 1.1 jmcneill switch (eclk->type) {
304 1.1 jmcneill case EXYNOS_CLK_FIXED:
305 1.1 jmcneill type = "fixed";
306 1.1 jmcneill break;
307 1.1 jmcneill case EXYNOS_CLK_PLL:
308 1.1 jmcneill type = "pll";
309 1.1 jmcneill break;
310 1.1 jmcneill case EXYNOS_CLK_MUX:
311 1.1 jmcneill type = "mux";
312 1.1 jmcneill break;
313 1.1 jmcneill case EXYNOS_CLK_DIV:
314 1.1 jmcneill type = "div";
315 1.1 jmcneill break;
316 1.1 jmcneill case EXYNOS_CLK_GATE:
317 1.1 jmcneill type = "gate";
318 1.1 jmcneill break;
319 1.1 jmcneill }
320 1.1 jmcneill
321 1.1 jmcneill clk_parent = exynos5422_clock_get_parent(sc, &eclk->base);
322 1.1 jmcneill eclk_parent = (struct exynos_clk *)clk_parent;
323 1.1 jmcneill
324 1.1 jmcneill printf(" %-10s %2s %-10s %-5s %10d Hz\n",
325 1.1 jmcneill eclk->base.name,
326 1.1 jmcneill eclk_parent ? "<-" : "",
327 1.1 jmcneill eclk_parent ? eclk_parent->base.name : "",
328 1.1 jmcneill type, clk_get_rate(&eclk->base));
329 1.1 jmcneill }
330 1.1 jmcneill
331 1.1 jmcneill static u_int
332 1.1 jmcneill exynos5422_clock_get_rate_pll(struct exynos5422_clock_softc *sc,
333 1.1 jmcneill struct exynos_clk *eclk)
334 1.1 jmcneill {
335 1.1 jmcneill struct exynos_pll_clk *epll = &eclk->u.pll;
336 1.1 jmcneill struct exynos_clk *clk_parent;
337 1.1 jmcneill
338 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_PLL);
339 1.1 jmcneill
340 1.1 jmcneill clk_parent = exynos5422_clock_find(eclk->parent);
341 1.1 jmcneill KASSERT(clk_parent != NULL);
342 1.1 jmcneill const u_int rate_parent = exynos5422_clock_get_rate(sc,
343 1.1 jmcneill &clk_parent->base);
344 1.1 jmcneill
345 1.1 jmcneill const uint32_t v = CLOCK_READ(sc, epll->con0_reg);
346 1.1 jmcneill
347 1.1 jmcneill return PLL_FREQ(rate_parent, v);
348 1.1 jmcneill }
349 1.1 jmcneill
350 1.1 jmcneill static int
351 1.1 jmcneill exynos5422_clock_set_rate_pll(struct exynos5422_clock_softc *sc,
352 1.1 jmcneill struct exynos_clk *eclk, u_int rate)
353 1.1 jmcneill {
354 1.1 jmcneill /* TODO */
355 1.1 jmcneill return EOPNOTSUPP;
356 1.1 jmcneill }
357 1.1 jmcneill
358 1.1 jmcneill static int
359 1.1 jmcneill exynos5422_clock_set_parent_mux(struct exynos5422_clock_softc *sc,
360 1.1 jmcneill struct exynos_clk *eclk, struct exynos_clk *eclk_parent)
361 1.1 jmcneill {
362 1.1 jmcneill struct exynos_mux_clk *emux = &eclk->u.mux;
363 1.1 jmcneill const char *pname = eclk_parent->base.name;
364 1.1 jmcneill u_int sel;
365 1.1 jmcneill
366 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_MUX);
367 1.1 jmcneill
368 1.1 jmcneill for (sel = 0; sel < emux->nparents; sel++) {
369 1.1 jmcneill if (strcmp(pname, emux->parents[sel]) == 0) {
370 1.1 jmcneill break;
371 1.1 jmcneill }
372 1.1 jmcneill }
373 1.1 jmcneill if (sel == emux->nparents) {
374 1.1 jmcneill return EINVAL;
375 1.1 jmcneill }
376 1.1 jmcneill
377 1.1 jmcneill uint32_t v = CLOCK_READ(sc, emux->reg);
378 1.1 jmcneill v &= ~emux->bits;
379 1.1 jmcneill v |= __SHIFTIN(sel, emux->bits);
380 1.1 jmcneill CLOCK_WRITE(sc, emux->reg, v);
381 1.1 jmcneill
382 1.1 jmcneill return 0;
383 1.1 jmcneill }
384 1.1 jmcneill
385 1.1 jmcneill static struct exynos_clk *
386 1.1 jmcneill exynos5422_clock_get_parent_mux(struct exynos5422_clock_softc *sc,
387 1.1 jmcneill struct exynos_clk *eclk)
388 1.1 jmcneill {
389 1.1 jmcneill struct exynos_mux_clk *emux = &eclk->u.mux;
390 1.1 jmcneill
391 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_MUX);
392 1.1 jmcneill
393 1.1 jmcneill const uint32_t v = CLOCK_READ(sc, emux->reg);
394 1.1 jmcneill const u_int sel = __SHIFTOUT(v, emux->bits);
395 1.1 jmcneill
396 1.1 jmcneill KASSERT(sel < emux->nparents);
397 1.1 jmcneill
398 1.1 jmcneill return exynos5422_clock_find(emux->parents[sel]);
399 1.1 jmcneill }
400 1.1 jmcneill
401 1.1 jmcneill static u_int
402 1.1 jmcneill exynos5422_clock_get_rate_div(struct exynos5422_clock_softc *sc,
403 1.1 jmcneill struct exynos_clk *eclk)
404 1.1 jmcneill {
405 1.2 jmcneill struct exynos_div_clk *ediv = &eclk->u.div;
406 1.1 jmcneill struct clk *clk_parent;
407 1.1 jmcneill
408 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_DIV);
409 1.1 jmcneill
410 1.1 jmcneill clk_parent = exynos5422_clock_get_parent(sc, &eclk->base);
411 1.1 jmcneill const u_int parent_rate = exynos5422_clock_get_rate(sc, clk_parent);
412 1.1 jmcneill
413 1.2 jmcneill const uint32_t v = CLOCK_READ(sc, ediv->reg);
414 1.2 jmcneill const u_int div = __SHIFTOUT(v, ediv->bits);
415 1.1 jmcneill
416 1.1 jmcneill return parent_rate / (div + 1);
417 1.1 jmcneill }
418 1.1 jmcneill
419 1.1 jmcneill static int
420 1.1 jmcneill exynos5422_clock_set_rate_div(struct exynos5422_clock_softc *sc,
421 1.1 jmcneill struct exynos_clk *eclk, u_int rate)
422 1.1 jmcneill {
423 1.2 jmcneill struct exynos_div_clk *ediv = &eclk->u.div;
424 1.1 jmcneill struct clk *clk_parent;
425 1.1 jmcneill int tmp_div, new_div = -1;
426 1.1 jmcneill u_int tmp_rate;
427 1.1 jmcneill
428 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_DIV);
429 1.1 jmcneill
430 1.1 jmcneill clk_parent = exynos5422_clock_get_parent(sc, &eclk->base);
431 1.1 jmcneill const u_int parent_rate = exynos5422_clock_get_rate(sc, clk_parent);
432 1.1 jmcneill
433 1.2 jmcneill for (tmp_div = 0; tmp_div < popcount32(ediv->bits); tmp_div++) {
434 1.1 jmcneill tmp_rate = parent_rate / (tmp_div + 1);
435 1.1 jmcneill if (tmp_rate <= rate) {
436 1.1 jmcneill new_div = tmp_div;
437 1.1 jmcneill break;
438 1.1 jmcneill }
439 1.1 jmcneill }
440 1.1 jmcneill if (new_div == -1)
441 1.1 jmcneill return EINVAL;
442 1.1 jmcneill
443 1.2 jmcneill uint32_t v = CLOCK_READ(sc, ediv->reg);
444 1.2 jmcneill v &= ~ediv->bits;
445 1.2 jmcneill v |= __SHIFTIN(new_div, ediv->bits);
446 1.2 jmcneill CLOCK_WRITE(sc, ediv->reg, v);
447 1.1 jmcneill
448 1.1 jmcneill return 0;
449 1.1 jmcneill }
450 1.1 jmcneill
451 1.1 jmcneill static int
452 1.1 jmcneill exynos5422_clock_enable_gate(struct exynos5422_clock_softc *sc,
453 1.1 jmcneill struct exynos_clk *eclk, bool enable)
454 1.1 jmcneill {
455 1.1 jmcneill struct exynos_gate_clk *egate = &eclk->u.gate;
456 1.1 jmcneill
457 1.1 jmcneill KASSERT(eclk->type == EXYNOS_CLK_GATE);
458 1.1 jmcneill
459 1.1 jmcneill uint32_t v = CLOCK_READ(sc, egate->reg);
460 1.1 jmcneill if (enable) {
461 1.1 jmcneill v |= egate->bits;
462 1.1 jmcneill } else {
463 1.1 jmcneill v &= ~egate->bits;
464 1.1 jmcneill }
465 1.1 jmcneill CLOCK_WRITE(sc, egate->reg, v);
466 1.1 jmcneill
467 1.1 jmcneill return 0;
468 1.1 jmcneill }
469 1.1 jmcneill
470 1.1 jmcneill /*
471 1.1 jmcneill * clk api
472 1.1 jmcneill */
473 1.1 jmcneill
474 1.1 jmcneill static struct clk *
475 1.1 jmcneill exynos5422_clock_get(void *priv, const char *name)
476 1.1 jmcneill {
477 1.1 jmcneill struct exynos_clk *eclk;
478 1.1 jmcneill
479 1.1 jmcneill eclk = exynos5422_clock_find(name);
480 1.1 jmcneill if (eclk == NULL)
481 1.1 jmcneill return NULL;
482 1.1 jmcneill
483 1.1 jmcneill atomic_inc_uint(&eclk->refcnt);
484 1.1 jmcneill
485 1.1 jmcneill return &eclk->base;
486 1.1 jmcneill }
487 1.1 jmcneill
488 1.1 jmcneill static void
489 1.1 jmcneill exynos5422_clock_put(void *priv, struct clk *clk)
490 1.1 jmcneill {
491 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
492 1.1 jmcneill
493 1.1 jmcneill KASSERT(eclk->refcnt > 0);
494 1.1 jmcneill
495 1.1 jmcneill atomic_dec_uint(&eclk->refcnt);
496 1.1 jmcneill }
497 1.1 jmcneill
498 1.1 jmcneill static u_int
499 1.1 jmcneill exynos5422_clock_get_rate(void *priv, struct clk *clk)
500 1.1 jmcneill {
501 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
502 1.1 jmcneill struct clk *clk_parent;
503 1.1 jmcneill
504 1.1 jmcneill switch (eclk->type) {
505 1.1 jmcneill case EXYNOS_CLK_FIXED:
506 1.1 jmcneill return eclk->u.fixed.rate;
507 1.1 jmcneill case EXYNOS_CLK_PLL:
508 1.1 jmcneill return exynos5422_clock_get_rate_pll(priv, eclk);
509 1.1 jmcneill case EXYNOS_CLK_MUX:
510 1.1 jmcneill case EXYNOS_CLK_GATE:
511 1.1 jmcneill clk_parent = exynos5422_clock_get_parent(priv, clk);
512 1.1 jmcneill return exynos5422_clock_get_rate(priv, clk_parent);
513 1.1 jmcneill case EXYNOS_CLK_DIV:
514 1.1 jmcneill return exynos5422_clock_get_rate_div(priv, eclk);
515 1.1 jmcneill default:
516 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
517 1.1 jmcneill }
518 1.1 jmcneill }
519 1.1 jmcneill
520 1.1 jmcneill static int
521 1.1 jmcneill exynos5422_clock_set_rate(void *priv, struct clk *clk, u_int rate)
522 1.1 jmcneill {
523 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
524 1.1 jmcneill
525 1.2 jmcneill KASSERT((clk->flags & CLK_SET_RATE_PARENT) == 0);
526 1.2 jmcneill
527 1.1 jmcneill switch (eclk->type) {
528 1.1 jmcneill case EXYNOS_CLK_FIXED:
529 1.1 jmcneill return EIO;
530 1.1 jmcneill case EXYNOS_CLK_PLL:
531 1.1 jmcneill return exynos5422_clock_set_rate_pll(priv, eclk, rate);
532 1.1 jmcneill case EXYNOS_CLK_MUX:
533 1.1 jmcneill return EIO;
534 1.1 jmcneill case EXYNOS_CLK_DIV:
535 1.1 jmcneill return exynos5422_clock_set_rate_div(priv, eclk, rate);
536 1.1 jmcneill case EXYNOS_CLK_GATE:
537 1.1 jmcneill return EINVAL;
538 1.1 jmcneill default:
539 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
540 1.1 jmcneill }
541 1.1 jmcneill }
542 1.1 jmcneill
543 1.1 jmcneill static int
544 1.1 jmcneill exynos5422_clock_enable(void *priv, struct clk *clk)
545 1.1 jmcneill {
546 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
547 1.1 jmcneill
548 1.1 jmcneill switch (eclk->type) {
549 1.1 jmcneill case EXYNOS_CLK_FIXED:
550 1.1 jmcneill return 0; /* always on */
551 1.1 jmcneill case EXYNOS_CLK_PLL:
552 1.1 jmcneill return 0; /* XXX */
553 1.1 jmcneill case EXYNOS_CLK_MUX:
554 1.1 jmcneill case EXYNOS_CLK_DIV:
555 1.1 jmcneill return 0;
556 1.1 jmcneill case EXYNOS_CLK_GATE:
557 1.1 jmcneill return exynos5422_clock_enable_gate(priv, eclk, true);
558 1.1 jmcneill default:
559 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
560 1.1 jmcneill }
561 1.1 jmcneill }
562 1.1 jmcneill
563 1.1 jmcneill static int
564 1.1 jmcneill exynos5422_clock_disable(void *priv, struct clk *clk)
565 1.1 jmcneill {
566 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
567 1.1 jmcneill
568 1.1 jmcneill switch (eclk->type) {
569 1.1 jmcneill case EXYNOS_CLK_FIXED:
570 1.1 jmcneill return EINVAL; /* always on */
571 1.1 jmcneill case EXYNOS_CLK_PLL:
572 1.1 jmcneill return EINVAL; /* XXX */
573 1.1 jmcneill case EXYNOS_CLK_MUX:
574 1.1 jmcneill case EXYNOS_CLK_DIV:
575 1.1 jmcneill return EINVAL;
576 1.1 jmcneill case EXYNOS_CLK_GATE:
577 1.1 jmcneill return exynos5422_clock_enable_gate(priv, eclk, false);
578 1.1 jmcneill default:
579 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
580 1.1 jmcneill }
581 1.1 jmcneill }
582 1.1 jmcneill
583 1.1 jmcneill static int
584 1.1 jmcneill exynos5422_clock_set_parent(void *priv, struct clk *clk, struct clk *clk_parent)
585 1.1 jmcneill {
586 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
587 1.1 jmcneill struct exynos_clk *eclk_parent = (struct exynos_clk *)clk_parent;
588 1.1 jmcneill
589 1.1 jmcneill switch (eclk->type) {
590 1.1 jmcneill case EXYNOS_CLK_FIXED:
591 1.1 jmcneill case EXYNOS_CLK_PLL:
592 1.1 jmcneill case EXYNOS_CLK_DIV:
593 1.1 jmcneill case EXYNOS_CLK_GATE:
594 1.1 jmcneill return EINVAL;
595 1.1 jmcneill case EXYNOS_CLK_MUX:
596 1.1 jmcneill return exynos5422_clock_set_parent_mux(priv, eclk, eclk_parent);
597 1.1 jmcneill default:
598 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
599 1.1 jmcneill }
600 1.1 jmcneill }
601 1.1 jmcneill
602 1.1 jmcneill static struct clk *
603 1.1 jmcneill exynos5422_clock_get_parent(void *priv, struct clk *clk)
604 1.1 jmcneill {
605 1.1 jmcneill struct exynos_clk *eclk = (struct exynos_clk *)clk;
606 1.1 jmcneill struct exynos_clk *eclk_parent = NULL;
607 1.1 jmcneill
608 1.1 jmcneill switch (eclk->type) {
609 1.1 jmcneill case EXYNOS_CLK_FIXED:
610 1.1 jmcneill case EXYNOS_CLK_PLL:
611 1.1 jmcneill case EXYNOS_CLK_DIV:
612 1.1 jmcneill case EXYNOS_CLK_GATE:
613 1.1 jmcneill if (eclk->parent != NULL) {
614 1.1 jmcneill eclk_parent = exynos5422_clock_find(eclk->parent);
615 1.1 jmcneill }
616 1.1 jmcneill break;
617 1.1 jmcneill case EXYNOS_CLK_MUX:
618 1.1 jmcneill eclk_parent = exynos5422_clock_get_parent_mux(priv, eclk);
619 1.1 jmcneill break;
620 1.1 jmcneill default:
621 1.1 jmcneill panic("exynos5422: unknown eclk type %d", eclk->type);
622 1.1 jmcneill }
623 1.1 jmcneill
624 1.1 jmcneill return &eclk_parent->base;
625 1.1 jmcneill }
626