Home | History | Annotate | Line # | Download | only in samsung
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