Home | History | Annotate | Line # | Download | only in samsung
      1  1.7   thorpej /* $NetBSD: exynos5410_clock.c,v 1.7 2021/01/27 03:10:19 thorpej Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*-
      4  1.1  jmcneill  * Copyright (c) 2015-2017 Jared 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 <sys/cdefs.h>
     30  1.7   thorpej __KERNEL_RCSID(0, "$NetBSD: exynos5410_clock.c,v 1.7 2021/01/27 03:10:19 thorpej Exp $");
     31  1.1  jmcneill 
     32  1.1  jmcneill #include <sys/param.h>
     33  1.1  jmcneill #include <sys/bus.h>
     34  1.1  jmcneill #include <sys/device.h>
     35  1.1  jmcneill #include <sys/intr.h>
     36  1.1  jmcneill #include <sys/systm.h>
     37  1.1  jmcneill #include <sys/kernel.h>
     38  1.1  jmcneill #include <sys/atomic.h>
     39  1.1  jmcneill 
     40  1.1  jmcneill #include <dev/clk/clk_backend.h>
     41  1.1  jmcneill 
     42  1.1  jmcneill #include <arm/samsung/exynos_reg.h>
     43  1.1  jmcneill #include <arm/samsung/exynos_var.h>
     44  1.1  jmcneill #include <arm/samsung/exynos_clock.h>
     45  1.1  jmcneill 
     46  1.1  jmcneill #include <dev/fdt/fdtvar.h>
     47  1.1  jmcneill 
     48  1.4   aymeric static struct clk *exynos5410_clock_decode(device_t, int, const void *, size_t);
     49  1.1  jmcneill 
     50  1.1  jmcneill static const struct fdtbus_clock_controller_func exynos5410_car_fdtclock_funcs = {
     51  1.1  jmcneill 	.decode = exynos5410_clock_decode
     52  1.1  jmcneill };
     53  1.1  jmcneill 
     54  1.1  jmcneill /* DT clock ID to clock name mappings */
     55  1.1  jmcneill static struct exynos5410_clock_id {
     56  1.1  jmcneill 	u_int		id;
     57  1.1  jmcneill 	const char	*name;
     58  1.1  jmcneill } exynos5410_clock_ids[] = {
     59  1.1  jmcneill     /* core clocks */
     60  1.1  jmcneill     { 1, "fin_pll" },
     61  1.1  jmcneill     { 2, "fout_apll" },
     62  1.1  jmcneill     { 3, "fout_cpll" },
     63  1.1  jmcneill     { 4, "fout_dpll" },
     64  1.1  jmcneill     { 5, "fout_mpll" },
     65  1.1  jmcneill     { 6, "fout_kpll" },
     66  1.1  jmcneill     { 7, "fout_epll" },
     67  1.1  jmcneill 
     68  1.1  jmcneill     /* gate for special clocks (sclk) */
     69  1.1  jmcneill     { 128, "sclk_uart0" },
     70  1.1  jmcneill     { 129, "sclk_uart1" },
     71  1.1  jmcneill     { 130, "sclk_uart2" },
     72  1.1  jmcneill     { 131, "sclk_uart3" },
     73  1.1  jmcneill     { 132, "sclk_mmc0" },
     74  1.1  jmcneill     { 133, "sclk_mmc1" },
     75  1.1  jmcneill     { 134, "sclk_mmc2" },
     76  1.1  jmcneill     { 150, "sclk_usbd300" },
     77  1.1  jmcneill     { 151, "sclk_usbd301" },
     78  1.1  jmcneill     { 152, "sclk_usbphy300" },
     79  1.1  jmcneill     { 153, "sclk_usbphy301" },
     80  1.1  jmcneill     { 155, "sclk_pwm" },
     81  1.1  jmcneill 
     82  1.1  jmcneill     /* gate clocks */
     83  1.1  jmcneill     { 257, "uart0" },
     84  1.1  jmcneill     { 258, "uart1" },
     85  1.1  jmcneill     { 259, "uart2" },
     86  1.1  jmcneill     { 260, "uart3" },
     87  1.1  jmcneill     { 261, "i2c0" },
     88  1.1  jmcneill     { 262, "i2c1" },
     89  1.1  jmcneill     { 263, "i2c2" },
     90  1.1  jmcneill     { 264, "i2c3" },
     91  1.1  jmcneill     { 265, "usi0" },
     92  1.1  jmcneill     { 266, "usi1" },
     93  1.1  jmcneill     { 267, "usi2" },
     94  1.1  jmcneill     { 268, "usi3" },
     95  1.1  jmcneill     { 279, "pwm" },
     96  1.1  jmcneill     { 315, "mct" },
     97  1.1  jmcneill     { 316, "wdt" },
     98  1.1  jmcneill     { 317, "rtc" },
     99  1.1  jmcneill     { 318, "tmu" },
    100  1.1  jmcneill     { 351, "mmc0" },
    101  1.1  jmcneill     { 352, "mmc1" },
    102  1.1  jmcneill     { 353, "mmc2" },
    103  1.1  jmcneill     { 362, "pdma0" },
    104  1.1  jmcneill     { 363, "pdma1" },
    105  1.1  jmcneill     { 365, "usbh20" },
    106  1.1  jmcneill     { 366, "usbd300" },
    107  1.1  jmcneill     { 367, "usbd301" },
    108  1.1  jmcneill     { 471, "sss" },
    109  1.1  jmcneill };
    110  1.1  jmcneill 
    111  1.1  jmcneill static struct clk *exynos5410_clock_get(void *, const char *);
    112  1.1  jmcneill static void	exynos5410_clock_put(void *, struct clk *);
    113  1.1  jmcneill static u_int	exynos5410_clock_get_rate(void *, struct clk *);
    114  1.1  jmcneill static int	exynos5410_clock_set_rate(void *, struct clk *, u_int);
    115  1.1  jmcneill static int	exynos5410_clock_enable(void *, struct clk *);
    116  1.1  jmcneill static int	exynos5410_clock_disable(void *, struct clk *);
    117  1.1  jmcneill static int	exynos5410_clock_set_parent(void *, struct clk *, struct clk *);
    118  1.1  jmcneill static struct clk *exynos5410_clock_get_parent(void *, struct clk *);
    119  1.1  jmcneill 
    120  1.1  jmcneill static const struct clk_funcs exynos5410_clock_funcs = {
    121  1.1  jmcneill 	.get = exynos5410_clock_get,
    122  1.1  jmcneill 	.put = exynos5410_clock_put,
    123  1.1  jmcneill 	.get_rate = exynos5410_clock_get_rate,
    124  1.1  jmcneill 	.set_rate = exynos5410_clock_set_rate,
    125  1.1  jmcneill 	.enable = exynos5410_clock_enable,
    126  1.1  jmcneill 	.disable = exynos5410_clock_disable,
    127  1.1  jmcneill 	.set_parent = exynos5410_clock_set_parent,
    128  1.1  jmcneill 	.get_parent = exynos5410_clock_get_parent,
    129  1.1  jmcneill };
    130  1.1  jmcneill 
    131  1.1  jmcneill #define CLK_FIXED(_name, _rate)	{				\
    132  1.1  jmcneill 	.base = { .name = (_name) }, .type = EXYNOS_CLK_FIXED,	\
    133  1.1  jmcneill 	.u = { .fixed = { .rate = (_rate) } }			\
    134  1.1  jmcneill }
    135  1.1  jmcneill 
    136  1.1  jmcneill #define CLK_PLL(_name, _parent, _lock, _con0) {			\
    137  1.1  jmcneill 	.base = { .name = (_name) }, .type = EXYNOS_CLK_PLL,	\
    138  1.1  jmcneill 	.parent = (_parent),					\
    139  1.1  jmcneill 	.u = {							\
    140  1.1  jmcneill 		.pll = {					\
    141  1.1  jmcneill 			.lock_reg = (_lock),			\
    142  1.1  jmcneill 			.con0_reg = (_con0),			\
    143  1.1  jmcneill 		}						\
    144  1.1  jmcneill 	}							\
    145  1.1  jmcneill }
    146  1.1  jmcneill 
    147  1.1  jmcneill #define CLK_MUXF(_name, _alias, _reg, _bits, _f, _p) {		\
    148  1.1  jmcneill 	.base = { .name = (_name), .flags = (_f) },		\
    149  1.1  jmcneill 	.type = EXYNOS_CLK_MUX,					\
    150  1.1  jmcneill 	.alias = (_alias),					\
    151  1.1  jmcneill 	.u = {							\
    152  1.1  jmcneill 		.mux = {					\
    153  1.1  jmcneill 	  		.nparents = __arraycount(_p),		\
    154  1.1  jmcneill 	  		.parents = (_p),			\
    155  1.1  jmcneill 			.reg = (_reg),				\
    156  1.1  jmcneill 			.bits = (_bits)				\
    157  1.1  jmcneill 		}						\
    158  1.1  jmcneill 	}							\
    159  1.1  jmcneill }
    160  1.1  jmcneill 
    161  1.1  jmcneill #define CLK_MUXA(_name, _alias, _reg, _bits, _p)		\
    162  1.1  jmcneill 	CLK_MUXF(_name, _alias, _reg, _bits, 0, _p)
    163  1.1  jmcneill 
    164  1.1  jmcneill #define CLK_MUX(_name, _reg, _bits, _p)				\
    165  1.1  jmcneill 	CLK_MUXF(_name, NULL, _reg, _bits, 0, _p)
    166  1.1  jmcneill 
    167  1.1  jmcneill #define CLK_DIVF(_name, _parent, _reg, _bits, _f) {		\
    168  1.1  jmcneill 	.base = { .name = (_name), .flags = (_f) },		\
    169  1.1  jmcneill 	.type = EXYNOS_CLK_DIV,					\
    170  1.1  jmcneill 	.parent = (_parent),					\
    171  1.1  jmcneill 	.u = {							\
    172  1.1  jmcneill 		.div = {					\
    173  1.1  jmcneill 			.reg = (_reg),				\
    174  1.1  jmcneill 			.bits = (_bits)				\
    175  1.1  jmcneill 		}						\
    176  1.1  jmcneill 	}							\
    177  1.1  jmcneill }
    178  1.1  jmcneill 
    179  1.1  jmcneill #define CLK_DIV(_name, _parent, _reg, _bits)			\
    180  1.1  jmcneill 	CLK_DIVF(_name, _parent, _reg, _bits, 0)
    181  1.1  jmcneill 
    182  1.1  jmcneill #define CLK_GATE(_name, _parent, _reg, _bits, _f) {		\
    183  1.1  jmcneill 	.base = { .name = (_name), .flags = (_f) },		\
    184  1.1  jmcneill 	.type = EXYNOS_CLK_GATE,				\
    185  1.1  jmcneill 	.parent = (_parent),					\
    186  1.1  jmcneill 	.u = {							\
    187  1.1  jmcneill 		.gate = {					\
    188  1.1  jmcneill 			.reg = (_reg),				\
    189  1.1  jmcneill 			.bits = (_bits)				\
    190  1.1  jmcneill 		}						\
    191  1.1  jmcneill 	}							\
    192  1.1  jmcneill }
    193  1.1  jmcneill 
    194  1.1  jmcneill #define EXYNOS5410_APLL_LOCK		0x00000
    195  1.1  jmcneill #define EXYNOS5410_APLL_CON0		0x00100
    196  1.1  jmcneill #define EXYNOS5410_MPLL_LOCK		0x04000
    197  1.1  jmcneill #define EXYNOS5410_MPLL_CON0		0x04100
    198  1.1  jmcneill #define EXYNOS5410_CPLL_LOCK		0x10020
    199  1.1  jmcneill #define EXYNOS5410_EPLL_LOCK		0x10040
    200  1.1  jmcneill #define EXYNOS5410_CPLL_CON0		0x10120
    201  1.1  jmcneill #define EXYNOS5410_EPLL_CON0		0x10130
    202  1.1  jmcneill #define EXYNOS5410_EPLL_CON1		0x10134
    203  1.1  jmcneill #define EXYNOS5410_EPLL_CON2		0x10138
    204  1.1  jmcneill #define EXYNOS5410_BPLL_LOCK		0x20010
    205  1.1  jmcneill #define EXYNOS5410_BPLL_CON0		0x20110
    206  1.1  jmcneill #define EXYNOS5410_KPLL_LOCK		0x28000
    207  1.1  jmcneill #define EXYNOS5410_KPLL_CON0		0x28100
    208  1.1  jmcneill 
    209  1.1  jmcneill #define EXYNOS5410_SRC_CPU		0x00200
    210  1.1  jmcneill #define EXYNOS5410_SRC_CPERI1		0x04204
    211  1.1  jmcneill #define EXYNOS5410_SRC_TOP0		0x10210
    212  1.1  jmcneill #define EXYNOS5410_SRC_TOP1		0x10214
    213  1.1  jmcneill #define EXYNOS5410_SRC_TOP2		0x10218
    214  1.1  jmcneill #define EXYNOS5410_SRC_FSYS		0x10244
    215  1.1  jmcneill #define EXYNOS5410_SRC_PERIC0		0x10250
    216  1.1  jmcneill #define EXYNOS5410_SRC_MASK_FSYS	0x10340
    217  1.1  jmcneill #define EXYNOS5410_SRC_MASK_PERIC0	0x10350
    218  1.1  jmcneill #define EXYNOS5410_SRC_CDREX		0x20200
    219  1.1  jmcneill #define EXYNOS5410_SRC_KFC		0x28200
    220  1.1  jmcneill 
    221  1.1  jmcneill #define EXYNOS5410_DIV_CPU0		0x00500
    222  1.1  jmcneill #define EXYNOS5410_DIV_TOP0		0x10510
    223  1.1  jmcneill #define EXYNOS5410_DIV_TOP1		0x10514
    224  1.1  jmcneill #define EXYNOS5410_DIV_FSYS0		0x10548
    225  1.1  jmcneill #define EXYNOS5410_DIV_FSYS1		0x1054c
    226  1.1  jmcneill #define EXYNOS5410_DIV_FSYS2		0x10550
    227  1.1  jmcneill #define EXYNOS5410_DIV_PERIC0		0x10558
    228  1.1  jmcneill #define EXYNOS5410_DIV_PERIC3		0x10564
    229  1.1  jmcneill #define EXYNOS5410_DIV_KFC0		0x28500
    230  1.1  jmcneill 
    231  1.1  jmcneill #define EXYNOS5410_GATE_IP_G2D		0x08800
    232  1.1  jmcneill #define EXYNOS5410_GATE_BUS_FSYS0	0x10740
    233  1.1  jmcneill #define EXYNOS5410_GATE_TOP_SCLK_FSYS	0x10840
    234  1.1  jmcneill #define EXYNOS5410_GATE_TOP_SCLK_PERIC	0x10850
    235  1.1  jmcneill #define EXYNOS5410_GATE_IP_FSYS		0x10944
    236  1.1  jmcneill #define EXYNOS5410_GATE_IP_PERIC	0x10950
    237  1.1  jmcneill #define EXYNOS5410_GATE_IP_PERIS	0x10960
    238  1.1  jmcneill 
    239  1.1  jmcneill static const char *mout_apll_p[] = { "fin_pll", "fout_apll" };
    240  1.1  jmcneill static const char *mout_bpll_p[] = { "fin_pll", "fout_bpll" };
    241  1.1  jmcneill static const char *mout_cpll_p[] = { "fin_pll", "fout_cpll" };
    242  1.1  jmcneill static const char *mout_epll_p[] = { "fin_pll", "fout_epll" };
    243  1.1  jmcneill static const char *mout_mpll_p[] = { "fin_pll", "fout_mpll" };
    244  1.1  jmcneill static const char *mout_kpll_p[] = { "fin_pll", "fout_kpll" };
    245  1.1  jmcneill 
    246  1.1  jmcneill static const char *mout_cpu_p[] = { "mout_apll", "sclk_mpll" };
    247  1.1  jmcneill static const char *mout_kfc_p[] = { "mout_kpll", "sclk_mpll" };
    248  1.1  jmcneill 
    249  1.1  jmcneill static const char *mout_mpll_user_p[] = { "fin_pll", "sclk_mpll" };
    250  1.1  jmcneill static const char *mout_bpll_user_p[] = { "fin_pll", "sclk_bpll" };
    251  1.1  jmcneill static const char *mout_mpll_bpll_p[] =
    252  1.1  jmcneill 	{ "sclk_mpll_muxed", "sclk_bpll_muxed" };
    253  1.1  jmcneill static const char *mout_sclk_mpll_bpll_p[] = { "sclk_mpll_bpll", "fin_pll" };
    254  1.1  jmcneill 
    255  1.1  jmcneill static const char *mout_group2_p[] =
    256  1.1  jmcneill 	{ "fin_pll", "fin_pll", "none", "none", "none", "none",
    257  1.1  jmcneill 	  "sclk_mpll_bpll", "none", "none", "sclk_cpll" };
    258  1.1  jmcneill 
    259  1.1  jmcneill static struct exynos_clk exynos5410_clocks[] = {
    260  1.1  jmcneill 	CLK_FIXED("fin_pll", EXYNOS_F_IN_FREQ),
    261  1.1  jmcneill 
    262  1.1  jmcneill 	CLK_PLL("fout_apll", "fin_pll", EXYNOS5410_APLL_LOCK,
    263  1.1  jmcneill 					EXYNOS5410_APLL_CON0),
    264  1.1  jmcneill 	CLK_PLL("fout_bpll", "fin_pll", EXYNOS5410_BPLL_LOCK,
    265  1.1  jmcneill 					EXYNOS5410_BPLL_CON0),
    266  1.1  jmcneill 	CLK_PLL("fout_cpll", "fin_pll", EXYNOS5410_CPLL_LOCK,
    267  1.1  jmcneill 					EXYNOS5410_CPLL_CON0),
    268  1.1  jmcneill 	CLK_PLL("fout_epll", "fin_pll", EXYNOS5410_EPLL_LOCK,
    269  1.1  jmcneill 					EXYNOS5410_EPLL_CON0),
    270  1.1  jmcneill 	CLK_PLL("fout_mpll", "fin_pll", EXYNOS5410_MPLL_LOCK,
    271  1.1  jmcneill 					EXYNOS5410_MPLL_CON0),
    272  1.1  jmcneill 	CLK_PLL("fout_kpll", "fin_pll", EXYNOS5410_KPLL_LOCK,
    273  1.1  jmcneill 					EXYNOS5410_KPLL_CON0),
    274  1.1  jmcneill 
    275  1.1  jmcneill 	CLK_MUX("mout_apll", EXYNOS5410_SRC_CPU, __BIT(0), mout_apll_p),
    276  1.1  jmcneill 	CLK_MUX("mout_cpu", EXYNOS5410_SRC_CPU, __BIT(16), mout_cpu_p),
    277  1.1  jmcneill 	CLK_MUX("mout_kpll", EXYNOS5410_SRC_KFC, __BIT(0), mout_kpll_p),
    278  1.1  jmcneill 	CLK_MUX("mout_kfc", EXYNOS5410_SRC_KFC, __BIT(16), mout_kfc_p),
    279  1.1  jmcneill 
    280  1.1  jmcneill 	CLK_MUX("sclk_mpll", EXYNOS5410_SRC_CPERI1, __BIT(8), mout_mpll_p),
    281  1.1  jmcneill 	CLK_MUX("sclk_mpll_muxed", EXYNOS5410_SRC_TOP2, __BIT(20), mout_mpll_user_p),
    282  1.1  jmcneill 	CLK_MUX("sclk_bpll", EXYNOS5410_SRC_CDREX, __BIT(0), mout_bpll_p),
    283  1.1  jmcneill 	CLK_MUX("sclk_bpll_muxed", EXYNOS5410_SRC_TOP2, __BIT(24), mout_bpll_user_p),
    284  1.1  jmcneill 	CLK_MUX("sclk_epll", EXYNOS5410_SRC_TOP2, __BIT(12), mout_epll_p),
    285  1.1  jmcneill 	CLK_MUX("sclk_cpll", EXYNOS5410_SRC_TOP2, __BIT(8), mout_cpll_p),
    286  1.1  jmcneill 	CLK_MUX("sclk_mpll_bpll", EXYNOS5410_SRC_TOP1, __BIT(20), mout_mpll_bpll_p),
    287  1.1  jmcneill 
    288  1.1  jmcneill 	CLK_MUX("mout_mmc0", EXYNOS5410_SRC_FSYS, __BITS(3,0), mout_group2_p),
    289  1.1  jmcneill 	CLK_MUX("mout_mmc1", EXYNOS5410_SRC_FSYS, __BITS(7,4), mout_group2_p),
    290  1.1  jmcneill 	CLK_MUX("mout_mmc2", EXYNOS5410_SRC_FSYS, __BITS(11,8), mout_group2_p),
    291  1.1  jmcneill 	CLK_MUX("mout_usbd300", EXYNOS5410_SRC_FSYS, __BIT(28), mout_sclk_mpll_bpll_p),
    292  1.1  jmcneill 	CLK_MUX("mout_usbd301", EXYNOS5410_SRC_FSYS, __BIT(29), mout_sclk_mpll_bpll_p),
    293  1.1  jmcneill 	CLK_MUX("mout_uart0", EXYNOS5410_SRC_PERIC0, __BITS(3,0), mout_group2_p),
    294  1.1  jmcneill 	CLK_MUX("mout_uart1", EXYNOS5410_SRC_PERIC0, __BITS(7,4), mout_group2_p),
    295  1.1  jmcneill 	CLK_MUX("mout_uart2", EXYNOS5410_SRC_PERIC0, __BITS(11,8), mout_group2_p),
    296  1.1  jmcneill 	CLK_MUX("mout_uart3", EXYNOS5410_SRC_PERIC0, __BITS(15,12), mout_group2_p),
    297  1.1  jmcneill 	CLK_MUX("mout_pwm", EXYNOS5410_SRC_PERIC0, __BITS(27,24), mout_group2_p),
    298  1.1  jmcneill 	CLK_MUX("mout_aclk200", EXYNOS5410_SRC_TOP0, __BIT(12), mout_mpll_bpll_p),
    299  1.1  jmcneill 	CLK_MUX("mout_aclk400", EXYNOS5410_SRC_TOP0, __BIT(20), mout_mpll_bpll_p),
    300  1.1  jmcneill 
    301  1.1  jmcneill 	CLK_DIV("div_arm", "mout_cpu", EXYNOS5410_DIV_CPU0, __BITS(2,0)),
    302  1.1  jmcneill 	CLK_DIV("div_arm2", "div_arm", EXYNOS5410_DIV_CPU0, __BITS(30,28)),
    303  1.1  jmcneill 
    304  1.1  jmcneill 	CLK_DIV("div_acp", "div_arm2", EXYNOS5410_DIV_CPU0, __BITS(10,8)),
    305  1.1  jmcneill 	CLK_DIV("div_cpud", "div_arm2", EXYNOS5410_DIV_CPU0, __BITS(6,4)),
    306  1.1  jmcneill 	CLK_DIV("div_atb", "div_arm2", EXYNOS5410_DIV_CPU0, __BITS(18,16)),
    307  1.1  jmcneill 	CLK_DIV("pclk_dbg", "div_arm2", EXYNOS5410_DIV_CPU0, __BITS(22,20)),
    308  1.1  jmcneill 
    309  1.1  jmcneill 	CLK_DIV("div_kfc", "mout_kfc", EXYNOS5410_DIV_KFC0, __BITS(2,0)),
    310  1.1  jmcneill 	CLK_DIV("div_aclk", "div_kfc", EXYNOS5410_DIV_KFC0, __BITS(6,4)),
    311  1.1  jmcneill 	CLK_DIV("div_pclk", "div_kfc", EXYNOS5410_DIV_KFC0, __BITS(22,20)),
    312  1.1  jmcneill 
    313  1.1  jmcneill 	CLK_DIV("aclk66_pre", "sclk_mpll_muxed", EXYNOS5410_DIV_TOP1, __BITS(26,24)),
    314  1.1  jmcneill 	CLK_DIV("aclk66", "aclk66_pre", EXYNOS5410_DIV_TOP0, __BITS(2,0)),
    315  1.1  jmcneill 
    316  1.1  jmcneill 	CLK_DIV("dout_usbphy300", "mout_usbd300", EXYNOS5410_DIV_FSYS0, __BITS(19,16)),
    317  1.1  jmcneill 	CLK_DIV("dout_usbphy301", "mout_usbd301", EXYNOS5410_DIV_FSYS0, __BITS(23,20)),
    318  1.1  jmcneill 	CLK_DIV("dout_usbd300", "mout_usbd300", EXYNOS5410_DIV_FSYS0, __BITS(27,24)),
    319  1.1  jmcneill 	CLK_DIV("dout_usbd301", "mout_usbd301", EXYNOS5410_DIV_FSYS0, __BITS(31,28)),
    320  1.1  jmcneill 
    321  1.1  jmcneill 	CLK_DIV("dout_mmc0", "mout_mmc0", EXYNOS5410_DIV_FSYS1, __BITS(3,0)),
    322  1.1  jmcneill 	CLK_DIV("dout_mmc1", "mout_mmc1", EXYNOS5410_DIV_FSYS1, __BITS(19,16)),
    323  1.1  jmcneill 	CLK_DIV("dout_mmc2", "mout_mmc2", EXYNOS5410_DIV_FSYS2, __BITS(3,0)),
    324  1.1  jmcneill 
    325  1.2     skrll 	CLK_DIVF("dout_mmc_pre0", "dout_mmc0", EXYNOS5410_DIV_FSYS1, __BITS(15,8),
    326  1.1  jmcneill 	    CLK_SET_RATE_PARENT),
    327  1.2     skrll 	CLK_DIVF("dout_mmc_pre1", "dout_mmc1", EXYNOS5410_DIV_FSYS1, __BITS(31,24),
    328  1.1  jmcneill 	    CLK_SET_RATE_PARENT),
    329  1.2     skrll 	CLK_DIVF("dout_mmc_pre2", "dout_mmc2", EXYNOS5410_DIV_FSYS2, __BITS(15,8),
    330  1.1  jmcneill 	    CLK_SET_RATE_PARENT),
    331  1.1  jmcneill 
    332  1.1  jmcneill 	CLK_DIV("div_uart0", "mout_uart0", EXYNOS5410_DIV_PERIC0, __BITS(3,0)),
    333  1.1  jmcneill 	CLK_DIV("div_uart1", "mout_uart1", EXYNOS5410_DIV_PERIC0, __BITS(7,4)),
    334  1.1  jmcneill 	CLK_DIV("div_uart2", "mout_uart2", EXYNOS5410_DIV_PERIC0, __BITS(11,8)),
    335  1.1  jmcneill 	CLK_DIV("div_uart3", "mout_uart3", EXYNOS5410_DIV_PERIC0, __BITS(15,12)),
    336  1.1  jmcneill 
    337  1.1  jmcneill 	CLK_DIV("dout_pwm", "mout_pwm", EXYNOS5410_DIV_PERIC3, __BITS(3,0)),
    338  1.1  jmcneill 
    339  1.1  jmcneill 	CLK_DIV("aclk200", "mout_aclk200", EXYNOS5410_DIV_TOP0, __BITS(14,12)),
    340  1.1  jmcneill 	CLK_DIV("aclk266", "sclk_mpll_muxed", EXYNOS5410_DIV_TOP0, __BITS(18,16)),
    341  1.1  jmcneill 	CLK_DIV("aclk400", "mout_aclk400", EXYNOS5410_DIV_TOP0, __BITS(26,24)),
    342  1.1  jmcneill 
    343  1.1  jmcneill 	CLK_GATE("sss", "aclk266", EXYNOS5410_GATE_IP_G2D, __BIT(2), 0),
    344  1.1  jmcneill 
    345  1.1  jmcneill 	CLK_GATE("mct", "aclk66", EXYNOS5410_GATE_IP_PERIS, __BIT(18), 0),
    346  1.1  jmcneill 	CLK_GATE("wdt", "aclk66", EXYNOS5410_GATE_IP_PERIS, __BIT(19), 0),
    347  1.1  jmcneill 	CLK_GATE("rtc", "aclk66", EXYNOS5410_GATE_IP_PERIS, __BIT(20), 0),
    348  1.1  jmcneill 	CLK_GATE("tmu", "aclk66", EXYNOS5410_GATE_IP_PERIS, __BIT(21), 0),
    349  1.1  jmcneill 
    350  1.2     skrll 	CLK_GATE("sclk_mmc0", "dout_mmc_pre0", EXYNOS5410_SRC_MASK_FSYS,
    351  1.1  jmcneill 	    __BIT(0), CLK_SET_RATE_PARENT),
    352  1.2     skrll 	CLK_GATE("sclk_mmc1", "dout_mmc_pre1", EXYNOS5410_SRC_MASK_FSYS,
    353  1.1  jmcneill 	    __BIT(4), CLK_SET_RATE_PARENT),
    354  1.2     skrll 	CLK_GATE("sclk_mmc2", "dout_mmc_pre2", EXYNOS5410_SRC_MASK_FSYS,
    355  1.1  jmcneill 	    __BIT(8), CLK_SET_RATE_PARENT),
    356  1.1  jmcneill 
    357  1.1  jmcneill 	CLK_GATE("mmc0", "aclk200", EXYNOS5410_GATE_BUS_FSYS0, __BIT(12), 0),
    358  1.1  jmcneill 	CLK_GATE("mmc1", "aclk200", EXYNOS5410_GATE_BUS_FSYS0, __BIT(13), 0),
    359  1.1  jmcneill 	CLK_GATE("mmc2", "aclk200", EXYNOS5410_GATE_BUS_FSYS0, __BIT(14), 0),
    360  1.1  jmcneill 	CLK_GATE("pdma1", "aclk200", EXYNOS5410_GATE_BUS_FSYS0, __BIT(2), 0),
    361  1.1  jmcneill 	CLK_GATE("pdma0", "aclk200", EXYNOS5410_GATE_BUS_FSYS0, __BIT(1), 0),
    362  1.1  jmcneill 
    363  1.1  jmcneill 	CLK_GATE("sclk_usbphy301", "dout_usbphy301", EXYNOS5410_GATE_TOP_SCLK_FSYS,
    364  1.1  jmcneill 	    __BIT(7), CLK_SET_RATE_PARENT),
    365  1.1  jmcneill 	CLK_GATE("sclk_usbphy300", "dout_usbphy300", EXYNOS5410_GATE_TOP_SCLK_FSYS,
    366  1.1  jmcneill 	    __BIT(8), CLK_SET_RATE_PARENT),
    367  1.1  jmcneill 	CLK_GATE("sclk_usbd301", "dout_usbd301", EXYNOS5410_GATE_TOP_SCLK_FSYS,
    368  1.1  jmcneill 	    __BIT(9), CLK_SET_RATE_PARENT),
    369  1.1  jmcneill 	CLK_GATE("sclk_usbd301", "dout_usbd301", EXYNOS5410_GATE_TOP_SCLK_FSYS,
    370  1.1  jmcneill 	    __BIT(10), CLK_SET_RATE_PARENT),
    371  1.1  jmcneill 
    372  1.1  jmcneill 	CLK_GATE("sclk_pwm", "dout_pwm", EXYNOS5410_GATE_TOP_SCLK_PERIC,
    373  1.1  jmcneill 	    __BIT(11), CLK_SET_RATE_PARENT),
    374  1.1  jmcneill 
    375  1.1  jmcneill 	CLK_GATE("uart0", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(0), 0),
    376  1.1  jmcneill 	CLK_GATE("uart1", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(1), 0),
    377  1.1  jmcneill 	CLK_GATE("uart2", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(2), 0),
    378  1.1  jmcneill 	CLK_GATE("uart3", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(3), 0),
    379  1.1  jmcneill 	CLK_GATE("i2c0", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(6), 0),
    380  1.1  jmcneill 	CLK_GATE("i2c1", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(7), 0),
    381  1.1  jmcneill 	CLK_GATE("i2c2", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(8), 0),
    382  1.1  jmcneill 	CLK_GATE("i2c3", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(9), 0),
    383  1.1  jmcneill 	CLK_GATE("usi0", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(10), 0),
    384  1.1  jmcneill 	CLK_GATE("usi1", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(11), 0),
    385  1.1  jmcneill 	CLK_GATE("usi2", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(12), 0),
    386  1.1  jmcneill 	CLK_GATE("usi3", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(13), 0),
    387  1.1  jmcneill 	CLK_GATE("pwm", "aclk66", EXYNOS5410_GATE_IP_PERIC, __BIT(24), 0),
    388  1.1  jmcneill 
    389  1.1  jmcneill 	CLK_GATE("sclk_uart0", "div_uart0", EXYNOS5410_SRC_MASK_PERIC0,
    390  1.1  jmcneill 	    __BIT(0), CLK_SET_RATE_PARENT),
    391  1.1  jmcneill 	CLK_GATE("sclk_uart1", "div_uart1", EXYNOS5410_SRC_MASK_PERIC0,
    392  1.1  jmcneill 	    __BIT(4), CLK_SET_RATE_PARENT),
    393  1.1  jmcneill 	CLK_GATE("sclk_uart2", "div_uart2", EXYNOS5410_SRC_MASK_PERIC0,
    394  1.1  jmcneill 	    __BIT(8), CLK_SET_RATE_PARENT),
    395  1.1  jmcneill 	CLK_GATE("sclk_uart3", "div_uart3", EXYNOS5410_SRC_MASK_PERIC0,
    396  1.1  jmcneill 	    __BIT(12), CLK_SET_RATE_PARENT),
    397  1.1  jmcneill 
    398  1.1  jmcneill 	CLK_GATE("usbh20", "aclk200", EXYNOS5410_GATE_IP_FSYS, __BIT(18), 0),
    399  1.1  jmcneill 	CLK_GATE("usbd301", "aclk200", EXYNOS5410_GATE_IP_FSYS, __BIT(19), 0),
    400  1.1  jmcneill 	CLK_GATE("usbd300", "aclk200", EXYNOS5410_GATE_IP_FSYS, __BIT(20), 0),
    401  1.1  jmcneill };
    402  1.1  jmcneill 
    403  1.1  jmcneill static int	exynos5410_clock_match(device_t, cfdata_t, void *);
    404  1.1  jmcneill static void	exynos5410_clock_attach(device_t, device_t, void *);
    405  1.1  jmcneill 
    406  1.1  jmcneill struct exynos5410_clock_softc {
    407  1.1  jmcneill 	device_t		sc_dev;
    408  1.1  jmcneill 	bus_space_tag_t		sc_bst;
    409  1.1  jmcneill 	bus_space_handle_t	sc_bsh;
    410  1.1  jmcneill 
    411  1.1  jmcneill 	struct clk_domain	sc_clkdom;
    412  1.1  jmcneill };
    413  1.1  jmcneill 
    414  1.1  jmcneill static void	exynos5410_clock_print_header(void);
    415  1.1  jmcneill static void	exynos5410_clock_print(struct exynos5410_clock_softc *,
    416  1.1  jmcneill 		    struct exynos_clk *);
    417  1.1  jmcneill 
    418  1.1  jmcneill CFATTACH_DECL_NEW(exynos5410_clock, sizeof(struct exynos5410_clock_softc),
    419  1.1  jmcneill 	exynos5410_clock_match, exynos5410_clock_attach, NULL, NULL);
    420  1.1  jmcneill 
    421  1.1  jmcneill #define CLOCK_READ(sc, reg)		\
    422  1.1  jmcneill     bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    423  1.1  jmcneill #define CLOCK_WRITE(sc, reg, val)	\
    424  1.1  jmcneill     bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    425  1.1  jmcneill 
    426  1.7   thorpej static const struct device_compatible_entry compat_data[] = {
    427  1.7   thorpej 	{ .compat = "samsung,exynos5410-clock" },
    428  1.7   thorpej 	DEVICE_COMPAT_EOL
    429  1.7   thorpej };
    430  1.7   thorpej 
    431  1.1  jmcneill static int
    432  1.1  jmcneill exynos5410_clock_match(device_t parent, cfdata_t cf, void *aux)
    433  1.1  jmcneill {
    434  1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    435  1.1  jmcneill 
    436  1.7   thorpej 	return of_compatible_match(faa->faa_phandle, compat_data);
    437  1.1  jmcneill }
    438  1.1  jmcneill 
    439  1.1  jmcneill static void
    440  1.1  jmcneill exynos5410_clock_attach(device_t parent, device_t self, void *aux)
    441  1.1  jmcneill {
    442  1.1  jmcneill 	struct exynos5410_clock_softc * const sc = device_private(self);
    443  1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    444  1.1  jmcneill 	bus_addr_t addr;
    445  1.1  jmcneill 	bus_size_t size;
    446  1.1  jmcneill 	int error;
    447  1.1  jmcneill 
    448  1.1  jmcneill 	if (fdtbus_get_reg(faa->faa_phandle, 0, &addr, &size) != 0) {
    449  1.1  jmcneill 		aprint_error(": couldn't get registers\n");
    450  1.1  jmcneill 		return;
    451  1.1  jmcneill 	}
    452  1.1  jmcneill 
    453  1.1  jmcneill 	sc->sc_dev = self;
    454  1.1  jmcneill 	sc->sc_bst = faa->faa_bst;
    455  1.6     skrll 
    456  1.1  jmcneill 	error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh);
    457  1.1  jmcneill 	if (error) {
    458  1.5     skrll 		aprint_error(": couldn't map %#" PRIxBUSADDR ": %d",
    459  1.5     skrll 			     addr, error);
    460  1.1  jmcneill 		return;
    461  1.1  jmcneill 	}
    462  1.1  jmcneill 
    463  1.1  jmcneill 	aprint_naive("\n");
    464  1.1  jmcneill 	aprint_normal(": Exynos5410 Clock Controller\n");
    465  1.1  jmcneill 
    466  1.1  jmcneill 	sc->sc_clkdom.funcs = &exynos5410_clock_funcs;
    467  1.1  jmcneill 	sc->sc_clkdom.priv = sc;
    468  1.1  jmcneill 	for (u_int n = 0; n < __arraycount(exynos5410_clocks); n++) {
    469  1.1  jmcneill 		exynos5410_clocks[n].base.domain = &sc->sc_clkdom;
    470  1.1  jmcneill 	}
    471  1.1  jmcneill 
    472  1.1  jmcneill 	fdtbus_register_clock_controller(self, faa->faa_phandle,
    473  1.1  jmcneill 	    &exynos5410_car_fdtclock_funcs);
    474  1.1  jmcneill 
    475  1.1  jmcneill 	exynos5410_clock_print_header();
    476  1.1  jmcneill 	for (u_int n = 0; n < __arraycount(exynos5410_clocks); n++) {
    477  1.1  jmcneill 		exynos5410_clock_print(sc, &exynos5410_clocks[n]);
    478  1.1  jmcneill 	}
    479  1.1  jmcneill }
    480  1.1  jmcneill 
    481  1.1  jmcneill static struct exynos_clk *
    482  1.1  jmcneill exynos5410_clock_find(const char *name)
    483  1.1  jmcneill {
    484  1.1  jmcneill 	u_int n;
    485  1.1  jmcneill 
    486  1.1  jmcneill 	for (n = 0; n < __arraycount(exynos5410_clocks); n++) {
    487  1.1  jmcneill 		if (strcmp(exynos5410_clocks[n].base.name, name) == 0) {
    488  1.1  jmcneill 			return &exynos5410_clocks[n];
    489  1.1  jmcneill 		}
    490  1.1  jmcneill 	}
    491  1.1  jmcneill 
    492  1.1  jmcneill 	return NULL;
    493  1.1  jmcneill }
    494  1.1  jmcneill 
    495  1.1  jmcneill static struct exynos_clk *
    496  1.1  jmcneill exynos5410_clock_find_by_id(u_int clock_id)
    497  1.1  jmcneill {
    498  1.1  jmcneill 	u_int n;
    499  1.1  jmcneill 
    500  1.1  jmcneill 	for (n = 0; n < __arraycount(exynos5410_clock_ids); n++) {
    501  1.1  jmcneill 		if (exynos5410_clock_ids[n].id == clock_id) {
    502  1.1  jmcneill 			const char *name = exynos5410_clock_ids[n].name;
    503  1.1  jmcneill 			return exynos5410_clock_find(name);
    504  1.1  jmcneill 		}
    505  1.1  jmcneill 	}
    506  1.1  jmcneill 
    507  1.1  jmcneill 	return NULL;
    508  1.1  jmcneill }
    509  1.1  jmcneill 
    510  1.1  jmcneill static void
    511  1.1  jmcneill exynos5410_clock_print_header(void)
    512  1.1  jmcneill {
    513  1.1  jmcneill 	printf("  %-10s %2s %-10s %-5s %10s\n",
    514  1.1  jmcneill 	    "clock", "", "parent", "type", "rate");
    515  1.1  jmcneill 	printf("  %-10s %2s %-10s %-5s %10s\n",
    516  1.1  jmcneill 	    "=====", "", "======", "====", "====");
    517  1.1  jmcneill }
    518  1.1  jmcneill 
    519  1.1  jmcneill static void
    520  1.1  jmcneill exynos5410_clock_print(struct exynos5410_clock_softc *sc,
    521  1.1  jmcneill     struct exynos_clk *eclk)
    522  1.1  jmcneill {
    523  1.1  jmcneill 	struct exynos_clk *eclk_parent;
    524  1.1  jmcneill 	struct clk *clk_parent;
    525  1.1  jmcneill 	const char *type = "?";
    526  1.1  jmcneill 
    527  1.1  jmcneill 	switch (eclk->type) {
    528  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    529  1.1  jmcneill 		type = "fixed";
    530  1.1  jmcneill 		break;
    531  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    532  1.1  jmcneill 		type = "pll";
    533  1.1  jmcneill 		break;
    534  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    535  1.1  jmcneill 		type = "mux";
    536  1.1  jmcneill 		break;
    537  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    538  1.1  jmcneill 		type = "div";
    539  1.1  jmcneill 		break;
    540  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    541  1.1  jmcneill 		type = "gate";
    542  1.1  jmcneill 		break;
    543  1.1  jmcneill 	}
    544  1.1  jmcneill 
    545  1.1  jmcneill 	clk_parent = exynos5410_clock_get_parent(sc, &eclk->base);
    546  1.1  jmcneill 	eclk_parent = (struct exynos_clk *)clk_parent;
    547  1.1  jmcneill 
    548  1.1  jmcneill 	printf("  %-10s %2s %-10s %-5s %10d Hz\n",
    549  1.1  jmcneill 	    eclk->base.name,
    550  1.1  jmcneill 	    eclk_parent ? "<-" : "",
    551  1.1  jmcneill 	    eclk_parent ? eclk_parent->base.name : "",
    552  1.1  jmcneill 	    type, clk_get_rate(&eclk->base));
    553  1.1  jmcneill }
    554  1.1  jmcneill 
    555  1.1  jmcneill static struct clk *
    556  1.4   aymeric exynos5410_clock_decode(device_t dev, int cc_phandle, const void *data,
    557  1.4   aymeric 			size_t len)
    558  1.1  jmcneill {
    559  1.1  jmcneill 	struct exynos_clk *eclk;
    560  1.1  jmcneill 
    561  1.1  jmcneill 	/* #clock-cells should be 1 */
    562  1.1  jmcneill 	if (len != 4) {
    563  1.1  jmcneill 		return NULL;
    564  1.1  jmcneill 	}
    565  1.1  jmcneill 
    566  1.1  jmcneill 	const u_int clock_id = be32dec(data);
    567  1.1  jmcneill 
    568  1.1  jmcneill 	eclk = exynos5410_clock_find_by_id(clock_id);
    569  1.1  jmcneill 	if (eclk)
    570  1.1  jmcneill 		return &eclk->base;
    571  1.1  jmcneill 
    572  1.1  jmcneill 	return NULL;
    573  1.1  jmcneill }
    574  1.1  jmcneill 
    575  1.1  jmcneill static u_int
    576  1.1  jmcneill exynos5410_clock_get_rate_pll(struct exynos5410_clock_softc *sc,
    577  1.1  jmcneill     struct exynos_clk *eclk)
    578  1.1  jmcneill {
    579  1.1  jmcneill 	struct exynos_pll_clk *epll = &eclk->u.pll;
    580  1.1  jmcneill 	struct exynos_clk *clk_parent;
    581  1.1  jmcneill 
    582  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_PLL);
    583  1.1  jmcneill 
    584  1.1  jmcneill 	clk_parent = exynos5410_clock_find(eclk->parent);
    585  1.1  jmcneill 	KASSERT(clk_parent != NULL);
    586  1.1  jmcneill 	const u_int rate_parent = exynos5410_clock_get_rate(sc,
    587  1.1  jmcneill 	    &clk_parent->base);
    588  1.1  jmcneill 
    589  1.1  jmcneill 	const uint32_t v = CLOCK_READ(sc, epll->con0_reg);
    590  1.6     skrll 
    591  1.1  jmcneill 	return PLL_FREQ(rate_parent, v);
    592  1.1  jmcneill }
    593  1.1  jmcneill 
    594  1.1  jmcneill static int
    595  1.1  jmcneill exynos5410_clock_set_rate_pll(struct exynos5410_clock_softc *sc,
    596  1.1  jmcneill     struct exynos_clk *eclk, u_int rate)
    597  1.1  jmcneill {
    598  1.1  jmcneill 	/* TODO */
    599  1.1  jmcneill 	return EOPNOTSUPP;
    600  1.1  jmcneill }
    601  1.1  jmcneill 
    602  1.1  jmcneill static int
    603  1.1  jmcneill exynos5410_clock_set_parent_mux(struct exynos5410_clock_softc *sc,
    604  1.1  jmcneill     struct exynos_clk *eclk, struct exynos_clk *eclk_parent)
    605  1.1  jmcneill {
    606  1.1  jmcneill 	struct exynos_mux_clk *emux = &eclk->u.mux;
    607  1.1  jmcneill 	const char *pname = eclk_parent->base.name;
    608  1.1  jmcneill 	u_int sel;
    609  1.1  jmcneill 
    610  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_MUX);
    611  1.1  jmcneill 
    612  1.1  jmcneill 	for (sel = 0; sel < emux->nparents; sel++) {
    613  1.1  jmcneill 		if (strcmp(pname, emux->parents[sel]) == 0) {
    614  1.1  jmcneill 			break;
    615  1.1  jmcneill 		}
    616  1.1  jmcneill 	}
    617  1.1  jmcneill 	if (sel == emux->nparents) {
    618  1.1  jmcneill 		return EINVAL;
    619  1.1  jmcneill 	}
    620  1.1  jmcneill 
    621  1.1  jmcneill 	uint32_t v = CLOCK_READ(sc, emux->reg);
    622  1.1  jmcneill 	v &= ~emux->bits;
    623  1.1  jmcneill 	v |= __SHIFTIN(sel, emux->bits);
    624  1.1  jmcneill 	CLOCK_WRITE(sc, emux->reg, v);
    625  1.1  jmcneill 
    626  1.1  jmcneill 	return 0;
    627  1.1  jmcneill }
    628  1.1  jmcneill 
    629  1.1  jmcneill static struct exynos_clk *
    630  1.1  jmcneill exynos5410_clock_get_parent_mux(struct exynos5410_clock_softc *sc,
    631  1.1  jmcneill     struct exynos_clk *eclk)
    632  1.1  jmcneill {
    633  1.1  jmcneill 	struct exynos_mux_clk *emux = &eclk->u.mux;
    634  1.1  jmcneill 
    635  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_MUX);
    636  1.1  jmcneill 
    637  1.1  jmcneill 	const uint32_t v = CLOCK_READ(sc, emux->reg);
    638  1.1  jmcneill 	const u_int sel = __SHIFTOUT(v, emux->bits);
    639  1.1  jmcneill 
    640  1.1  jmcneill 	KASSERT(sel < emux->nparents);
    641  1.1  jmcneill 
    642  1.1  jmcneill 	return exynos5410_clock_find(emux->parents[sel]);
    643  1.1  jmcneill }
    644  1.1  jmcneill 
    645  1.1  jmcneill static u_int
    646  1.1  jmcneill exynos5410_clock_get_rate_div(struct exynos5410_clock_softc *sc,
    647  1.1  jmcneill     struct exynos_clk *eclk)
    648  1.1  jmcneill {
    649  1.1  jmcneill 	struct exynos_div_clk *ediv = &eclk->u.div;
    650  1.1  jmcneill 	struct clk *clk_parent;
    651  1.1  jmcneill 
    652  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_DIV);
    653  1.1  jmcneill 
    654  1.1  jmcneill 	clk_parent = exynos5410_clock_get_parent(sc, &eclk->base);
    655  1.1  jmcneill 	const u_int parent_rate = exynos5410_clock_get_rate(sc, clk_parent);
    656  1.1  jmcneill 
    657  1.1  jmcneill 	const uint32_t v = CLOCK_READ(sc, ediv->reg);
    658  1.1  jmcneill 	const u_int div = __SHIFTOUT(v, ediv->bits);
    659  1.1  jmcneill 
    660  1.1  jmcneill 	return parent_rate / (div + 1);
    661  1.1  jmcneill }
    662  1.1  jmcneill 
    663  1.1  jmcneill static int
    664  1.1  jmcneill exynos5410_clock_set_rate_div(struct exynos5410_clock_softc *sc,
    665  1.1  jmcneill     struct exynos_clk *eclk, u_int rate)
    666  1.1  jmcneill {
    667  1.1  jmcneill 	struct exynos_div_clk *ediv = &eclk->u.div;
    668  1.1  jmcneill 	struct clk *clk_parent;
    669  1.1  jmcneill 	int tmp_div, new_div = -1;
    670  1.1  jmcneill 	u_int tmp_rate;
    671  1.1  jmcneill 
    672  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_DIV);
    673  1.1  jmcneill 
    674  1.1  jmcneill 	clk_parent = exynos5410_clock_get_parent(sc, &eclk->base);
    675  1.1  jmcneill 	const u_int parent_rate = exynos5410_clock_get_rate(sc, clk_parent);
    676  1.1  jmcneill 
    677  1.3  jmcneill 	for (tmp_div = 0; tmp_div < __SHIFTOUT_MASK(ediv->bits); tmp_div++) {
    678  1.1  jmcneill 		tmp_rate = parent_rate / (tmp_div + 1);
    679  1.1  jmcneill 		if (tmp_rate <= rate) {
    680  1.1  jmcneill 			new_div = tmp_div;
    681  1.1  jmcneill 			break;
    682  1.1  jmcneill 		}
    683  1.1  jmcneill 	}
    684  1.1  jmcneill 	if (new_div == -1)
    685  1.1  jmcneill 		return EINVAL;
    686  1.1  jmcneill 
    687  1.1  jmcneill 	uint32_t v = CLOCK_READ(sc, ediv->reg);
    688  1.1  jmcneill 	v &= ~ediv->bits;
    689  1.1  jmcneill 	v |= __SHIFTIN(new_div, ediv->bits);
    690  1.1  jmcneill 	CLOCK_WRITE(sc, ediv->reg, v);
    691  1.1  jmcneill 
    692  1.1  jmcneill 	return 0;
    693  1.1  jmcneill }
    694  1.1  jmcneill 
    695  1.1  jmcneill static int
    696  1.1  jmcneill exynos5410_clock_enable_gate(struct exynos5410_clock_softc *sc,
    697  1.1  jmcneill     struct exynos_clk *eclk, bool enable)
    698  1.1  jmcneill {
    699  1.1  jmcneill 	struct exynos_gate_clk *egate = &eclk->u.gate;
    700  1.1  jmcneill 
    701  1.1  jmcneill 	KASSERT(eclk->type == EXYNOS_CLK_GATE);
    702  1.1  jmcneill 
    703  1.1  jmcneill 	uint32_t v = CLOCK_READ(sc, egate->reg);
    704  1.1  jmcneill 	if (enable) {
    705  1.1  jmcneill 		v |= egate->bits;
    706  1.1  jmcneill 	} else {
    707  1.1  jmcneill 		v &= ~egate->bits;
    708  1.1  jmcneill 	}
    709  1.1  jmcneill 	CLOCK_WRITE(sc, egate->reg, v);
    710  1.1  jmcneill 
    711  1.1  jmcneill 	return 0;
    712  1.1  jmcneill }
    713  1.1  jmcneill 
    714  1.1  jmcneill /*
    715  1.1  jmcneill  * clk api
    716  1.1  jmcneill  */
    717  1.1  jmcneill 
    718  1.1  jmcneill static struct clk *
    719  1.1  jmcneill exynos5410_clock_get(void *priv, const char *name)
    720  1.1  jmcneill {
    721  1.1  jmcneill 	struct exynos_clk *eclk;
    722  1.1  jmcneill 
    723  1.1  jmcneill 	eclk = exynos5410_clock_find(name);
    724  1.1  jmcneill 	if (eclk == NULL)
    725  1.1  jmcneill 		return NULL;
    726  1.1  jmcneill 
    727  1.1  jmcneill 	atomic_inc_uint(&eclk->refcnt);
    728  1.1  jmcneill 
    729  1.1  jmcneill 	return &eclk->base;
    730  1.1  jmcneill }
    731  1.1  jmcneill 
    732  1.1  jmcneill static void
    733  1.1  jmcneill exynos5410_clock_put(void *priv, struct clk *clk)
    734  1.1  jmcneill {
    735  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    736  1.1  jmcneill 
    737  1.1  jmcneill 	KASSERT(eclk->refcnt > 0);
    738  1.1  jmcneill 
    739  1.1  jmcneill 	atomic_dec_uint(&eclk->refcnt);
    740  1.1  jmcneill }
    741  1.1  jmcneill 
    742  1.1  jmcneill static u_int
    743  1.1  jmcneill exynos5410_clock_get_rate(void *priv, struct clk *clk)
    744  1.1  jmcneill {
    745  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    746  1.1  jmcneill 	struct clk *clk_parent;
    747  1.1  jmcneill 
    748  1.1  jmcneill 	switch (eclk->type) {
    749  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    750  1.1  jmcneill 		return eclk->u.fixed.rate;
    751  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    752  1.1  jmcneill 		return exynos5410_clock_get_rate_pll(priv, eclk);
    753  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    754  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    755  1.1  jmcneill 		clk_parent = exynos5410_clock_get_parent(priv, clk);
    756  1.1  jmcneill 		return exynos5410_clock_get_rate(priv, clk_parent);
    757  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    758  1.1  jmcneill 		return exynos5410_clock_get_rate_div(priv, eclk);
    759  1.1  jmcneill 	default:
    760  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    761  1.1  jmcneill 	}
    762  1.1  jmcneill }
    763  1.1  jmcneill 
    764  1.1  jmcneill static int
    765  1.1  jmcneill exynos5410_clock_set_rate(void *priv, struct clk *clk, u_int rate)
    766  1.1  jmcneill {
    767  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    768  1.1  jmcneill 
    769  1.1  jmcneill 	KASSERT((clk->flags & CLK_SET_RATE_PARENT) == 0);
    770  1.1  jmcneill 
    771  1.1  jmcneill 	switch (eclk->type) {
    772  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    773  1.1  jmcneill 		return EIO;
    774  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    775  1.1  jmcneill 		return exynos5410_clock_set_rate_pll(priv, eclk, rate);
    776  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    777  1.1  jmcneill 		return EIO;
    778  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    779  1.1  jmcneill 		return exynos5410_clock_set_rate_div(priv, eclk, rate);
    780  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    781  1.1  jmcneill 		return EINVAL;
    782  1.1  jmcneill 	default:
    783  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    784  1.1  jmcneill 	}
    785  1.1  jmcneill }
    786  1.1  jmcneill 
    787  1.1  jmcneill static int
    788  1.1  jmcneill exynos5410_clock_enable(void *priv, struct clk *clk)
    789  1.1  jmcneill {
    790  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    791  1.1  jmcneill 
    792  1.1  jmcneill 	switch (eclk->type) {
    793  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    794  1.1  jmcneill 		return 0;	/* always on */
    795  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    796  1.1  jmcneill 		return 0;	/* XXX */
    797  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    798  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    799  1.1  jmcneill 		return 0;
    800  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    801  1.1  jmcneill 		return exynos5410_clock_enable_gate(priv, eclk, true);
    802  1.1  jmcneill 	default:
    803  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    804  1.1  jmcneill 	}
    805  1.1  jmcneill }
    806  1.1  jmcneill 
    807  1.1  jmcneill static int
    808  1.1  jmcneill exynos5410_clock_disable(void *priv, struct clk *clk)
    809  1.1  jmcneill {
    810  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    811  1.1  jmcneill 
    812  1.1  jmcneill 	switch (eclk->type) {
    813  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    814  1.1  jmcneill 		return EINVAL;	/* always on */
    815  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    816  1.1  jmcneill 		return EINVAL;	/* XXX */
    817  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    818  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    819  1.1  jmcneill 		return EINVAL;
    820  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    821  1.1  jmcneill 		return exynos5410_clock_enable_gate(priv, eclk, false);
    822  1.1  jmcneill 	default:
    823  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    824  1.1  jmcneill 	}
    825  1.1  jmcneill }
    826  1.1  jmcneill 
    827  1.1  jmcneill static int
    828  1.1  jmcneill exynos5410_clock_set_parent(void *priv, struct clk *clk, struct clk *clk_parent)
    829  1.1  jmcneill {
    830  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    831  1.1  jmcneill 	struct exynos_clk *eclk_parent = (struct exynos_clk *)clk_parent;
    832  1.1  jmcneill 
    833  1.1  jmcneill 	switch (eclk->type) {
    834  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    835  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    836  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    837  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    838  1.1  jmcneill 		return EINVAL;
    839  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    840  1.1  jmcneill 		return exynos5410_clock_set_parent_mux(priv, eclk, eclk_parent);
    841  1.1  jmcneill 	default:
    842  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    843  1.1  jmcneill 	}
    844  1.1  jmcneill }
    845  1.1  jmcneill 
    846  1.1  jmcneill static struct clk *
    847  1.1  jmcneill exynos5410_clock_get_parent(void *priv, struct clk *clk)
    848  1.1  jmcneill {
    849  1.1  jmcneill 	struct exynos_clk *eclk = (struct exynos_clk *)clk;
    850  1.1  jmcneill 	struct exynos_clk *eclk_parent = NULL;
    851  1.1  jmcneill 
    852  1.1  jmcneill 	switch (eclk->type) {
    853  1.1  jmcneill 	case EXYNOS_CLK_FIXED:
    854  1.1  jmcneill 	case EXYNOS_CLK_PLL:
    855  1.1  jmcneill 	case EXYNOS_CLK_DIV:
    856  1.1  jmcneill 	case EXYNOS_CLK_GATE:
    857  1.1  jmcneill 		if (eclk->parent != NULL) {
    858  1.1  jmcneill 			eclk_parent = exynos5410_clock_find(eclk->parent);
    859  1.1  jmcneill 		}
    860  1.1  jmcneill 		break;
    861  1.1  jmcneill 	case EXYNOS_CLK_MUX:
    862  1.1  jmcneill 		eclk_parent = exynos5410_clock_get_parent_mux(priv, eclk);
    863  1.1  jmcneill 		break;
    864  1.1  jmcneill 	default:
    865  1.1  jmcneill 		panic("exynos5410: unknown eclk type %d", eclk->type);
    866  1.1  jmcneill 	}
    867  1.1  jmcneill 
    868  1.1  jmcneill 	return (struct clk *)eclk_parent;
    869  1.1  jmcneill }
    870