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