Home | History | Annotate | Line # | Download | only in samsung
exynos5422_clock.c revision 1.1
      1  1.1  jmcneill /* $NetBSD: exynos5422_clock.c,v 1.1 2015/12/05 13:32:27 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.1  jmcneill __KERNEL_RCSID(0, "$NetBSD: exynos5422_clock.c,v 1.1 2015/12/05 13:32:27 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.1  jmcneill 	struct exynos_mux_clk *emux = &eclk->u.mux;
    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.1  jmcneill 	const uint32_t v = CLOCK_READ(sc, emux->reg);
    414  1.1  jmcneill 	const u_int div = __SHIFTOUT(v, emux->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.1  jmcneill 	struct exynos_mux_clk *emux = &eclk->u.mux;
    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.1  jmcneill 	for (tmp_div = 0; tmp_div < popcount32(emux->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.1  jmcneill 	uint32_t v = CLOCK_READ(sc, emux->reg);
    444  1.1  jmcneill 	v &= ~emux->bits;
    445  1.1  jmcneill 	v |= __SHIFTIN(new_div, emux->bits);
    446  1.1  jmcneill 	CLOCK_WRITE(sc, emux->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.1  jmcneill 	switch (eclk->type) {
    526  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    527  1.1  jmcneill 		return EIO;
    528  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    529  1.1  jmcneill 		return exynos5422_clock_set_rate_pll(priv, eclk, rate);
    530  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    531  1.1  jmcneill 		return EIO;
    532  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    533  1.1  jmcneill 		return exynos5422_clock_set_rate_div(priv, eclk, rate);
    534  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    535  1.1  jmcneill 		return EINVAL;
    536  1.1  jmcneill 	default:
    537  1.1  jmcneill 		panic("exynos5422: unknown eclk type %d", eclk->type);
    538  1.1  jmcneill 	}
    539  1.1  jmcneill }
    540  1.1  jmcneill 
    541  1.1  jmcneill static int
    542  1.1  jmcneill exynos5422_clock_enable(void *priv, struct clk *clk)
    543  1.1  jmcneill {
    544  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    545  1.1  jmcneill 
    546  1.1  jmcneill 	switch (eclk->type) {
    547  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    548  1.1  jmcneill 		return 0;	/* always on */
    549  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    550  1.1  jmcneill 		return 0;	/* XXX */
    551  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    552  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    553  1.1  jmcneill 		return 0;
    554  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    555  1.1  jmcneill 		return exynos5422_clock_enable_gate(priv, eclk, true);
    556  1.1  jmcneill 	default:
    557  1.1  jmcneill 		panic("exynos5422: unknown eclk type %d", eclk->type);
    558  1.1  jmcneill 	}
    559  1.1  jmcneill }
    560  1.1  jmcneill 
    561  1.1  jmcneill static int
    562  1.1  jmcneill exynos5422_clock_disable(void *priv, struct clk *clk)
    563  1.1  jmcneill {
    564  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    565  1.1  jmcneill 
    566  1.1  jmcneill 	switch (eclk->type) {
    567  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    568  1.1  jmcneill 		return EINVAL;	/* always on */
    569  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    570  1.1  jmcneill 		return EINVAL;	/* XXX */
    571  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    572  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    573  1.1  jmcneill 		return EINVAL;
    574  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    575  1.1  jmcneill 		return exynos5422_clock_enable_gate(priv, eclk, false);
    576  1.1  jmcneill 	default:
    577  1.1  jmcneill 		panic("exynos5422: unknown eclk type %d", eclk->type);
    578  1.1  jmcneill 	}
    579  1.1  jmcneill }
    580  1.1  jmcneill 
    581  1.1  jmcneill static int
    582  1.1  jmcneill exynos5422_clock_set_parent(void *priv, struct clk *clk, struct clk *clk_parent)
    583  1.1  jmcneill {
    584  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    585  1.1  jmcneill 	struct exynos_clk *eclk_parent = (struct exynos_clk *)clk_parent;
    586  1.1  jmcneill 
    587  1.1  jmcneill 	switch (eclk->type) {
    588  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    589  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    590  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    591  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    592  1.1  jmcneill 		return EINVAL;
    593  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    594  1.1  jmcneill 		return exynos5422_clock_set_parent_mux(priv, eclk, eclk_parent);
    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 struct clk *
    601  1.1  jmcneill exynos5422_clock_get_parent(void *priv, struct clk *clk)
    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 = NULL;
    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 		if (eclk->parent != NULL) {
    612  1.1  jmcneill 			eclk_parent = exynos5422_clock_find(eclk->parent);
    613  1.1  jmcneill 		}
    614  1.1  jmcneill 		break;
    615  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    616  1.1  jmcneill 		eclk_parent = exynos5422_clock_get_parent_mux(priv, eclk);
    617  1.1  jmcneill 		break;
    618  1.1  jmcneill 	default:
    619  1.1  jmcneill 		panic("exynos5422: unknown eclk type %d", eclk->type);
    620  1.1  jmcneill 	}
    621  1.1  jmcneill 
    622  1.1  jmcneill 	return &eclk_parent->base;
    623  1.1  jmcneill }
    624