Home | History | Annotate | Line # | Download | only in samsung
exynos_soc.c revision 1.22
      1  1.22  reinoud /*	$NetBSD: exynos_soc.c,v 1.22 2014/09/30 12:55:29 reinoud Exp $	*/
      2  1.20    skrll 
      3   1.1     matt /*-
      4   1.1     matt  * Copyright (c) 2014 The NetBSD Foundation, Inc.
      5   1.1     matt  * All rights reserved.
      6   1.1     matt  *
      7   1.1     matt  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1     matt  * by Reinoud Zandijk.
      9   1.1     matt  *
     10   1.1     matt  * Redistribution and use in source and binary forms, with or without
     11   1.1     matt  * modification, are permitted provided that the following conditions
     12   1.1     matt  * are met:
     13   1.1     matt  * 1. Redistributions of source code must retain the above copyright
     14   1.1     matt  *    notice, this list of conditions and the following disclaimer.
     15   1.1     matt  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1     matt  *    notice, this list of conditions and the following disclaimer in the
     17   1.1     matt  *    documentation and/or other materials provided with the distribution.
     18   1.1     matt  *
     19   1.1     matt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1     matt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1     matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1     matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1     matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1     matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1     matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1     matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1     matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1     matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1     matt  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1     matt  */
     31   1.1     matt 
     32   1.1     matt #include "opt_exynos.h"
     33   1.1     matt 
     34   1.1     matt #define	_ARM32_BUS_DMA_PRIVATE
     35   1.1     matt 
     36   1.1     matt #include <sys/cdefs.h>
     37  1.22  reinoud __KERNEL_RCSID(1, "$NetBSD: exynos_soc.c,v 1.22 2014/09/30 12:55:29 reinoud Exp $");
     38   1.1     matt 
     39   1.1     matt #include <sys/param.h>
     40   1.1     matt #include <sys/bus.h>
     41   1.1     matt #include <sys/cpu.h>
     42   1.1     matt #include <sys/device.h>
     43   1.1     matt 
     44   1.1     matt #include <prop/proplib.h>
     45   1.1     matt 
     46   1.1     matt #include <net/if.h>
     47   1.1     matt #include <net/if_ether.h>
     48   1.1     matt 
     49   1.1     matt #include <arm/locore.h>
     50   1.1     matt 
     51   1.1     matt #include <arm/mainbus/mainbus.h>
     52   1.1     matt #include <arm/cortex/mpcore_var.h>
     53   1.1     matt 
     54   1.1     matt #include <arm/samsung/exynos_reg.h>
     55   1.1     matt #include <arm/samsung/exynos_var.h>
     56  1.14     matt #include <arm/samsung/mct_reg.h>
     57   1.1     matt #include <arm/samsung/smc.h>
     58   1.1     matt 
     59   1.1     matt #include <arm/cortex/pl310_var.h>
     60   1.1     matt #include <arm/cortex/pl310_reg.h>
     61   1.1     matt 
     62   1.1     matt /* XXXNH */
     63   1.1     matt #include <evbarm/odroid/platform.h>
     64   1.1     matt 
     65   1.1     matt 
     66   1.1     matt /* these variables are retrieved in start.S and stored in .data */
     67   1.1     matt uint32_t  exynos_soc_id = 0;
     68   1.1     matt uint32_t  exynos_pop_id = 0;
     69   1.1     matt 
     70  1.16  reinoud /* cpu frequencies */
     71  1.16  reinoud struct cpu_freq {
     72  1.16  reinoud 	uint64_t freq;
     73  1.16  reinoud 	int	 P;
     74  1.16  reinoud 	int	 M;
     75  1.16  reinoud 	int	 S;
     76  1.16  reinoud };
     77  1.16  reinoud 
     78  1.16  reinoud 
     79  1.16  reinoud #ifdef EXYNOS4
     80  1.16  reinoud const struct cpu_freq cpu_freq_settings_exynos4[] = {
     81  1.16  reinoud 	{ 200, 3, 100, 2},
     82  1.16  reinoud 	{ 300, 4, 200, 2},
     83  1.16  reinoud 	{ 400, 3, 100, 1},
     84  1.16  reinoud 	{ 500, 3, 125, 1},
     85  1.16  reinoud 	{ 600, 4, 200, 1},
     86  1.16  reinoud 	{ 700, 3, 175, 1},
     87  1.16  reinoud 	{ 800, 3, 100, 0},
     88  1.16  reinoud 	{ 900, 4, 150, 0},
     89  1.16  reinoud 	{1000, 3, 125, 0},
     90  1.16  reinoud 	{1100, 6, 275, 0},
     91  1.16  reinoud 	{1200, 4, 200, 0},
     92  1.16  reinoud 	{1300, 6, 325, 0},
     93  1.16  reinoud 	{1400, 3, 175, 0},
     94  1.16  reinoud 	{1600, 3, 200, 0},
     95  1.16  reinoud };
     96  1.16  reinoud #endif
     97  1.16  reinoud 
     98  1.16  reinoud 
     99  1.16  reinoud #ifdef EXYNOS5
    100  1.16  reinoud const struct cpu_freq cpu_freq_settings_exynos5[] = {
    101  1.16  reinoud 	{ 200,  3, 100, 2},
    102  1.16  reinoud 	{ 333,  4, 222, 2},
    103  1.16  reinoud 	{ 400,  3, 100, 1},
    104  1.16  reinoud 	{ 533, 12, 533, 1},
    105  1.16  reinoud 	{ 600,  4, 200, 1},
    106  1.16  reinoud 	{ 667,  7, 389, 1},
    107  1.16  reinoud 	{ 800,  3, 100, 0},
    108  1.16  reinoud 	{1000,  3, 125, 0},
    109  1.16  reinoud 	{1066, 12, 533, 0},
    110  1.16  reinoud 	{1200,  3, 150, 0},
    111  1.16  reinoud 	{1400,  3, 175, 0},
    112  1.16  reinoud 	{1600,  3, 200, 0},
    113  1.16  reinoud };
    114  1.16  reinoud #endif
    115  1.16  reinoud 
    116  1.16  reinoud static struct cpu_freq const *cpu_freq_settings = NULL;
    117  1.16  reinoud static int ncpu_freq_settings = 0;
    118  1.16  reinoud 
    119  1.16  reinoud static int cpu_freq_target = 0;
    120  1.16  reinoud #define NFRQS 15
    121  1.16  reinoud static char sysctl_cpu_freqs_txt[NFRQS*5];
    122  1.16  reinoud 
    123  1.21  reinoud bus_space_handle_t exynos_core_bsh;
    124  1.21  reinoud bus_space_handle_t exynos_audiocore_bsh;
    125  1.21  reinoud 
    126  1.21  reinoud bus_space_handle_t exynos_wdt_bsh;
    127  1.21  reinoud bus_space_handle_t exynos_pmu_bsh;
    128  1.21  reinoud bus_space_handle_t exynos_cmu_bsh;
    129  1.21  reinoud bus_space_handle_t exynos_cmu_apll_bsh;
    130  1.22  reinoud bus_space_handle_t exynos_sysreg_bsh;
    131  1.21  reinoud 
    132  1.21  reinoud 
    133  1.16  reinoud static int sysctl_cpufreq_target(SYSCTLFN_ARGS);
    134  1.16  reinoud static int sysctl_cpufreq_current(SYSCTLFN_ARGS);
    135  1.16  reinoud 
    136   1.1     matt /*
    137   1.1     matt  * the early serial console
    138   1.1     matt  */
    139   1.1     matt #ifdef EXYNOS_CONSOLE_EARLY
    140   1.1     matt 
    141   1.1     matt #include "opt_sscom.h"
    142   1.1     matt #include <arm/samsung/sscom_reg.h>
    143   1.1     matt #include <arm/samsung/sscom_var.h>
    144   1.1     matt #include <dev/cons.h>
    145   1.1     matt 
    146   1.1     matt static volatile uint8_t *uart_base;
    147   1.1     matt 
    148   1.1     matt #define CON_REG(a) (*((volatile uint32_t *)(uart_base + (a))))
    149   1.1     matt 
    150   1.1     matt static int
    151   1.1     matt exynos_cngetc(dev_t dv)
    152   1.1     matt {
    153   1.1     matt         if ((CON_REG(SSCOM_UTRSTAT) & UTRSTAT_RXREADY) == 0)
    154   1.1     matt 		return -1;
    155   1.1     matt 
    156   1.1     matt 	return CON_REG(SSCOM_URXH);
    157   1.1     matt }
    158   1.1     matt 
    159   1.1     matt static void
    160   1.1     matt exynos_cnputc(dev_t dv, int c)
    161   1.1     matt {
    162   1.1     matt 	int timo = 150000;
    163   1.1     matt 
    164   1.1     matt 	while ((CON_REG(SSCOM_UFSTAT) & UFSTAT_TXFULL) && --timo > 0);
    165   1.1     matt 
    166   1.1     matt 	CON_REG(SSCOM_UTXH) = c & 0xff;
    167   1.1     matt }
    168   1.1     matt 
    169   1.1     matt static struct consdev exynos_earlycons = {
    170   1.1     matt 	.cn_putc = exynos_cnputc,
    171   1.1     matt 	.cn_getc = exynos_cngetc,
    172   1.1     matt 	.cn_pollc = nullcnpollc,
    173   1.1     matt };
    174   1.1     matt #endif /* EXYNOS_CONSOLE_EARLY */
    175   1.1     matt 
    176   1.1     matt 
    177   1.1     matt #ifdef ARM_TRUSTZONE_FIRMWARE
    178   1.2  reinoud int
    179   1.1     matt exynos_do_idle(void)
    180   1.1     matt {
    181   1.1     matt         exynos_smc(SMC_CMD_SLEEP, 0, 0, 0);
    182   1.1     matt 
    183   1.1     matt 	return 0;
    184   1.1     matt }
    185   1.1     matt 
    186   1.1     matt 
    187   1.2  reinoud int
    188   1.1     matt exynos_set_cpu_boot_addr(int cpu, vaddr_t boot_addr)
    189   1.1     matt {
    190   1.2  reinoud 	/* XXX we need to map in iRAM space for this XXX */
    191   1.1     matt 	return 0;
    192   1.1     matt }
    193   1.1     matt 
    194   1.1     matt 
    195   1.2  reinoud int
    196   1.1     matt exynos_cpu_boot(int cpu)
    197   1.1     matt {
    198   1.1     matt 	exynos_smc(SMC_CMD_CPU1BOOT, cpu, 0, 0);
    199   1.1     matt 
    200   1.1     matt 	return 0;
    201   1.1     matt }
    202   1.1     matt 
    203   1.1     matt 
    204   1.1     matt /*
    205  1.17      snj  * The latency values used below are `magic' and probably chosen empirically.
    206   1.1     matt  * For the 4210 variant the data latency is lower, a 0x110. This is currently
    207   1.1     matt  * not enforced.
    208   1.1     matt  *
    209   1.1     matt  * The prefetch values are also different for the revision 0 of the
    210   1.1     matt  * Exynos4412, but why?
    211   1.1     matt  */
    212   1.1     matt 
    213   1.2  reinoud int
    214   1.1     matt exynos_l2cc_init(void)
    215   1.1     matt {
    216   1.1     matt 	const uint32_t tag_latency  = 0x110;
    217   1.2  reinoud 	const uint32_t data_latency = IS_EXYNOS4410_P() ? 0x110 : 0x120;
    218   1.1     matt 	const uint32_t prefetch4412   = /* 0111 0001 0000 0000 0000 0000 0000 0111 */
    219   1.1     matt 				PREFETCHCTL_DBLLINEF_EN  |
    220   1.1     matt 				PREFETCHCTL_INSTRPREF_EN |
    221   1.1     matt 				PREFETCHCTL_DATAPREF_EN  |
    222   1.1     matt 				PREFETCHCTL_PREF_DROP_EN |
    223   1.1     matt 				PREFETCHCTL_PREFETCH_OFFSET_7;
    224   1.1     matt 	const uint32_t prefetch4412_r0 = /* 0011 0000 0000 0000 0000 0000 0000 0111 */
    225   1.1     matt 				PREFETCHCTL_INSTRPREF_EN |
    226   1.1     matt 				PREFETCHCTL_DATAPREF_EN  |
    227   1.1     matt 				PREFETCHCTL_PREFETCH_OFFSET_7;
    228   1.1     matt 	const uint32_t aux_val      =    /* 0111 1100 0100 0111 0000 0000 0000 0001 */
    229   1.1     matt 				AUXCTL_EARLY_BRESP_EN |
    230   1.1     matt 				AUXCTL_I_PREFETCH     |
    231   1.1     matt 				AUXCTL_D_PREFETCH     |
    232   1.1     matt 				AUXCTL_NS_INT_ACC_CTL |
    233   1.1     matt 				AUXCTL_NS_INT_LOCK_EN |
    234   1.1     matt 				AUXCTL_SHARED_ATT_OVR |
    235   1.1     matt 				AUXCTL_WAY_SIZE_RSVD7 << 16 | /* why rsvd7 ??? */
    236   1.1     matt 				AUXCTL_FULL_LINE_WR0;
    237   1.1     matt 	const uint32_t aux_keepmask =    /* 1100 0010 0000 0000 1111 1111 1111 1111  */
    238   1.1     matt 				AUXCTL_RSVD31         |
    239   1.1     matt 				AUXCTL_EARLY_BRESP_EN |
    240   1.1     matt 				AUXCTL_CACHE_REPL_RR  |
    241   1.1     matt 
    242   1.1     matt 				AUXCTL_SH_ATTR_INV_ENA|
    243   1.1     matt 				AUXCTL_EXCL_CACHE_CFG |
    244   1.1     matt 				AUXCTL_ST_BUF_DEV_LIM_EN |
    245   1.1     matt 				AUXCTL_HIPRO_SO_DEV_EN |
    246   1.1     matt 				AUXCTL_FULL_LINE_WR0  |
    247   1.1     matt 				0xffff;
    248   1.1     matt 	uint32_t prefetch;
    249   1.1     matt 
    250   1.1     matt 	/* check the bitmaps are the same as the linux implementation uses */
    251   1.1     matt 	KASSERT(prefetch4412    == 0x71000007);
    252   1.1     matt 	KASSERT(prefetch4412_r0 == 0x30000007);
    253   1.1     matt 	KASSERT(aux_val         == 0x7C470001);
    254   1.1     matt 	KASSERT(aux_keepmask    == 0xC200FFFF);
    255   1.1     matt 
    256   1.2  reinoud 	if (IS_EXYNOS4412_R0_P())
    257   1.1     matt 		prefetch = prefetch4412_r0;
    258   1.1     matt 	else
    259   1.1     matt 		prefetch = prefetch4412;	/* newer than >= r1_0 */
    260   1.1     matt 	;
    261   1.1     matt 
    262   1.1     matt 	exynos_smc(SMC_CMD_L2X0SETUP1, tag_latency, data_latency, prefetch);
    263   1.1     matt 	exynos_smc(SMC_CMD_L2X0SETUP2,
    264   1.1     matt 		POWERCTL_DYNCLKGATE | POWERCTL_STANDBY,
    265   1.1     matt 		aux_val, aux_keepmask);
    266   1.1     matt 	exynos_smc(SMC_CMD_L2X0INVALL, 0, 0, 0);
    267   1.1     matt 	exynos_smc(SMC_CMD_L2X0CTRL, 1, 0, 0);
    268   1.1     matt 
    269   1.1     matt 	return 0;
    270   1.1     matt }
    271   1.2  reinoud #endif /* ARM_TRUSTZONE_FIRMWARE */
    272   1.1     matt 
    273   1.1     matt 
    274   1.1     matt void
    275  1.16  reinoud exynos_sysctl_cpufreq_init(void)
    276  1.16  reinoud {
    277  1.16  reinoud 	const struct sysctlnode *node, *cpunode, *freqnode;
    278  1.16  reinoud 	char *cpos;
    279  1.16  reinoud 	int i, val;
    280  1.16  reinoud 	int error;
    281  1.16  reinoud 
    282  1.16  reinoud 	memset(sysctl_cpu_freqs_txt, (int) ' ', sizeof(sysctl_cpu_freqs_txt));
    283  1.16  reinoud 	cpos = sysctl_cpu_freqs_txt;
    284  1.16  reinoud 	for (i = 0; i < ncpu_freq_settings; i++) {
    285  1.16  reinoud 		val = cpu_freq_settings[i].freq;
    286  1.16  reinoud 		snprintf(cpos, 6, "%d ", val);
    287  1.16  reinoud 		cpos += (val < 1000) ? 4 : 5;
    288  1.16  reinoud 	}
    289  1.16  reinoud 	*cpos = 0;
    290  1.16  reinoud 
    291  1.16  reinoud 	error = sysctl_createv(NULL, 0, NULL, &node,
    292  1.16  reinoud 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "machdep", NULL,
    293  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_MACHDEP, CTL_EOL);
    294  1.16  reinoud 	if (error)
    295  1.16  reinoud 		printf("couldn't create `machdep' node\n");
    296  1.16  reinoud 
    297  1.16  reinoud 	error = sysctl_createv(NULL, 0, &node, &cpunode,
    298  1.16  reinoud 	    0, CTLTYPE_NODE, "cpu", NULL,
    299  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
    300  1.16  reinoud 	if (error)
    301  1.16  reinoud 		printf("couldn't create `cpu' node\n");
    302  1.16  reinoud 
    303  1.16  reinoud 	error = sysctl_createv(NULL, 0, &cpunode, &freqnode,
    304  1.16  reinoud 	    0, CTLTYPE_NODE, "frequency", NULL,
    305  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
    306  1.16  reinoud 	if (error)
    307  1.16  reinoud 		printf("couldn't create `frequency' node\n");
    308  1.16  reinoud 
    309  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    310  1.16  reinoud 	    CTLFLAG_READWRITE, CTLTYPE_INT, "target", NULL,
    311  1.16  reinoud 	    sysctl_cpufreq_target, 0, &cpu_freq_target, 0,
    312  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    313  1.16  reinoud 	if (error)
    314  1.16  reinoud 		printf("couldn't create `target' node\n");
    315  1.16  reinoud 
    316  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    317  1.16  reinoud 	    0, CTLTYPE_INT, "current", NULL,
    318  1.16  reinoud 	    sysctl_cpufreq_current, 0, NULL, 0,
    319  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    320  1.16  reinoud 	if (error)
    321  1.16  reinoud 		printf("couldn't create `current' node\n");
    322  1.16  reinoud 
    323  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    324  1.16  reinoud 	    CTLFLAG_READONLY, CTLTYPE_STRING, "available", NULL,
    325  1.16  reinoud 	    NULL, 0, sysctl_cpu_freqs_txt, 0,
    326  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    327  1.16  reinoud 	if (error)
    328  1.16  reinoud 		printf("couldn't create `available' node\b");
    329  1.16  reinoud }
    330  1.16  reinoud 
    331  1.16  reinoud 
    332  1.16  reinoud uint64_t
    333  1.16  reinoud exynos_get_cpufreq(void)
    334  1.16  reinoud {
    335  1.16  reinoud 	uint32_t regval;
    336  1.16  reinoud 	uint32_t freq;
    337  1.16  reinoud 
    338  1.21  reinoud 	regval = bus_space_read_4(&exynos_bs_tag, exynos_cmu_apll_bsh,
    339  1.21  reinoud 			PLL_CON0_OFFSET);
    340  1.16  reinoud 	freq   = PLL_FREQ(EXYNOS_F_IN_FREQ, regval);
    341  1.16  reinoud 
    342  1.16  reinoud 	return freq;
    343  1.16  reinoud }
    344  1.16  reinoud 
    345  1.16  reinoud 
    346  1.16  reinoud static void
    347  1.16  reinoud exynos_set_cpufreq(const struct cpu_freq *freqreq)
    348  1.16  reinoud {
    349  1.18  reinoud 	struct cpu_info *ci;
    350  1.16  reinoud 	uint32_t regval;
    351  1.16  reinoud 	int M, P, S;
    352  1.18  reinoud 	int cii;
    353  1.16  reinoud 
    354  1.16  reinoud 	M = freqreq->M;
    355  1.16  reinoud 	P = freqreq->P;
    356  1.16  reinoud 	S = freqreq->S;
    357  1.16  reinoud 
    358  1.16  reinoud 	regval = __SHIFTIN(M, PLL_CON0_M) |
    359  1.16  reinoud 		 __SHIFTIN(P, PLL_CON0_P) |
    360  1.16  reinoud 		 __SHIFTIN(S, PLL_CON0_S);
    361  1.16  reinoud 
    362  1.16  reinoud 	/* enable PPL and write config */
    363  1.16  reinoud 	regval |= PLL_CON0_ENABLE;
    364  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_cmu_apll_bsh, PLL_CON0_OFFSET,
    365  1.21  reinoud 		regval);
    366  1.18  reinoud 
    367  1.18  reinoud 	/* update our cycle counter i.e. our CPU frequency for all CPUs */
    368  1.18  reinoud 	for (CPU_INFO_FOREACH(cii, ci)) {
    369  1.18  reinoud 		ci->ci_data.cpu_cc_freq = exynos_get_cpufreq();
    370  1.18  reinoud 	}
    371  1.16  reinoud }
    372  1.16  reinoud 
    373  1.16  reinoud 
    374  1.16  reinoud static int
    375  1.16  reinoud sysctl_cpufreq_target(SYSCTLFN_ARGS)
    376  1.16  reinoud {
    377  1.16  reinoud 	struct sysctlnode node;
    378  1.16  reinoud 	uint32_t t, curfreq, minfreq, maxfreq;
    379  1.16  reinoud 	int i, best_i, diff;
    380  1.16  reinoud 	int error;
    381  1.16  reinoud 
    382  1.16  reinoud 	curfreq = exynos_get_cpufreq() / (1000*1000);
    383  1.16  reinoud 	t = *(int *)rnode->sysctl_data;
    384  1.16  reinoud 	if (t == 0)
    385  1.16  reinoud 		t = curfreq;
    386  1.16  reinoud 
    387  1.16  reinoud 	node = *rnode;
    388  1.16  reinoud 	node.sysctl_data = &t;
    389  1.16  reinoud 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
    390  1.16  reinoud 	if (error || newp == NULL)
    391  1.16  reinoud 		return error;
    392  1.16  reinoud 
    393  1.16  reinoud 	minfreq = cpu_freq_settings[0].freq;
    394  1.16  reinoud 	maxfreq = cpu_freq_settings[ncpu_freq_settings-1].freq;
    395  1.16  reinoud 
    396  1.16  reinoud 	if ((t < minfreq) || (t > maxfreq))
    397  1.16  reinoud 		return EINVAL;
    398  1.16  reinoud 
    399  1.16  reinoud 	if (t == curfreq) {
    400  1.16  reinoud 		*(int *)rnode->sysctl_data = t;
    401  1.16  reinoud 		return 0;
    402  1.16  reinoud 	}
    403  1.16  reinoud 
    404  1.16  reinoud 	diff = maxfreq;
    405  1.16  reinoud 	best_i = -1;
    406  1.16  reinoud 	for (i = 0; i < ncpu_freq_settings; i++) {
    407  1.16  reinoud 		if (abs(t - cpu_freq_settings[i].freq) <= diff) {
    408  1.16  reinoud 			diff = labs(t - cpu_freq_settings[i].freq);
    409  1.16  reinoud 			best_i = i;
    410  1.16  reinoud 		}
    411  1.16  reinoud 	}
    412  1.16  reinoud 	if (best_i < 0)
    413  1.16  reinoud 		return EINVAL;
    414  1.16  reinoud 
    415  1.16  reinoud 	exynos_set_cpufreq(&cpu_freq_settings[best_i]);
    416  1.16  reinoud 
    417  1.16  reinoud 	*(int *)rnode->sysctl_data = t;
    418  1.16  reinoud 	return 0;
    419  1.16  reinoud }
    420  1.16  reinoud 
    421  1.16  reinoud 
    422  1.16  reinoud static int
    423  1.16  reinoud sysctl_cpufreq_current(SYSCTLFN_ARGS)
    424  1.16  reinoud {
    425  1.16  reinoud 	struct sysctlnode node = *rnode;
    426  1.16  reinoud 	uint32_t freq;
    427  1.16  reinoud 
    428  1.16  reinoud 	freq = exynos_get_cpufreq() / (1000*1000);
    429  1.16  reinoud 	node.sysctl_data = &freq;
    430  1.16  reinoud 
    431  1.16  reinoud 	return sysctl_lookup(SYSCTLFN_CALL(&node));
    432  1.16  reinoud }
    433  1.16  reinoud 
    434  1.16  reinoud 
    435  1.19  reinoud #ifdef VERBOSE_INIT_ARM
    436  1.19  reinoud #define DUMP_PLL(v, var) \
    437  1.19  reinoud 	reg = EXYNOS##v##_CMU_##var + PLL_CON0_OFFSET;\
    438  1.21  reinoud 	regval = bus_space_read_4(&exynos_bs_tag, exynos_cmu_bsh, reg); \
    439  1.19  reinoud 	freq   = PLL_FREQ(EXYNOS_F_IN_FREQ, regval); \
    440  1.19  reinoud 	printf("%8s at %d Mhz\n", #var, freq/(1000*1000));
    441  1.19  reinoud 
    442  1.19  reinoud 
    443  1.19  reinoud static void
    444  1.19  reinoud exynos_dump_clocks(void)
    445  1.19  reinoud {
    446  1.19  reinoud 	uint32_t reg = 0;
    447  1.19  reinoud 	uint32_t regval;
    448  1.19  reinoud 	uint32_t freq;
    449  1.19  reinoud 
    450  1.19  reinoud 	printf("Initial PLL settings\n");
    451  1.19  reinoud #ifdef EXYNOS4
    452  1.21  reinoud 	DUMP_PLL(4, APLL);
    453  1.21  reinoud 	DUMP_PLL(4, MPLL);
    454  1.21  reinoud 	DUMP_PLL(4, EPLL);
    455  1.21  reinoud 	DUMP_PLL(4, VPLL);
    456  1.19  reinoud #endif
    457  1.19  reinoud #ifdef EXYNOS5
    458  1.21  reinoud 	DUMP_PLL(5, APLL);
    459  1.21  reinoud 	DUMP_PLL(5, MPLL);
    460  1.21  reinoud 	DUMP_PLL(5, EPLL);
    461  1.21  reinoud 	DUMP_PLL(5, VPLL);
    462  1.21  reinoud 	DUMP_PLL(5, CPLL);
    463  1.21  reinoud 	DUMP_PLL(5, GPLL);
    464  1.21  reinoud 	DUMP_PLL(5, BPLL);
    465  1.19  reinoud #endif
    466  1.19  reinoud }
    467  1.19  reinoud #undef DUMP_PLL
    468  1.19  reinoud #endif
    469  1.19  reinoud 
    470  1.19  reinoud 
    471  1.21  reinoud /* XXX clock stuff needs major work XXX */
    472  1.21  reinoud static void
    473  1.21  reinoud exynos_init_clkout_for_usb(void)
    474  1.16  reinoud {
    475  1.16  reinoud #ifdef EXYNOS4
    476  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_pmu_bsh,
    477  1.21  reinoud 		EXYNOS_PMU_DEBUG_CLKOUT, 0x900);
    478  1.16  reinoud #endif
    479  1.16  reinoud #ifdef EXYNOS5
    480  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_pmu_bsh,
    481  1.21  reinoud 		EXYNOS_PMU_DEBUG_CLKOUT, 0x1000);
    482  1.16  reinoud #endif
    483  1.21  reinoud }
    484  1.21  reinoud 
    485  1.21  reinoud 
    486  1.21  reinoud void
    487  1.21  reinoud exynos_clocks_bootstrap(void)
    488  1.21  reinoud {
    489  1.16  reinoud 	KASSERT(ncpu_freq_settings != 0);
    490  1.16  reinoud 	KASSERT(ncpu_freq_settings < NFRQS);
    491  1.16  reinoud 
    492  1.19  reinoud #ifdef VERBOSE_INIT_ARM
    493  1.19  reinoud 	exynos_dump_clocks();
    494  1.19  reinoud #endif
    495  1.19  reinoud 
    496  1.16  reinoud 	/* set max cpufreq */
    497  1.16  reinoud 	exynos_set_cpufreq(&cpu_freq_settings[ncpu_freq_settings-1]);
    498  1.21  reinoud 
    499  1.21  reinoud 	/* set external USB frequency to XCLKOUT */
    500  1.21  reinoud 	exynos_init_clkout_for_usb();
    501  1.16  reinoud }
    502  1.16  reinoud 
    503  1.16  reinoud 
    504  1.16  reinoud void
    505   1.1     matt exynos_bootstrap(vaddr_t iobase, vaddr_t uartbase)
    506   1.1     matt {
    507   1.5  reinoud 	int error;
    508  1.11  reinoud 	size_t core_size, audiocore_size;
    509  1.21  reinoud 	bus_addr_t audiocore_pbase;
    510  1.21  reinoud 	bus_addr_t audiocore_vbase __diagused;
    511  1.21  reinoud 	bus_addr_t exynos_wdt_offset;
    512  1.21  reinoud 	bus_addr_t exynos_pmu_offset;
    513  1.22  reinoud 	bus_addr_t exynos_sysreg_offset;
    514  1.21  reinoud 	bus_addr_t exynos_cmu_apll_offset;
    515  1.21  reinoud 
    516  1.21  reinoud 	/* set up early console so we can use printf() and friends */
    517  1.21  reinoud #ifdef EXYNOS_CONSOLE_EARLY
    518  1.21  reinoud 	uart_base = (volatile uint8_t *) uartbase;
    519  1.21  reinoud 	cn_tab = &exynos_earlycons;
    520  1.21  reinoud 	printf("Exynos early console operational\n\n");
    521  1.21  reinoud #endif
    522  1.11  reinoud 
    523  1.11  reinoud #ifdef EXYNOS4
    524  1.21  reinoud 	core_size = EXYNOS4_CORE_SIZE;
    525  1.21  reinoud 	audiocore_size = EXYNOS4_AUDIOCORE_SIZE;
    526  1.21  reinoud 	audiocore_pbase = EXYNOS4_AUDIOCORE_PBASE;
    527  1.21  reinoud 	audiocore_vbase = EXYNOS4_AUDIOCORE_VBASE;
    528  1.21  reinoud 	exynos_wdt_offset = EXYNOS4_WDT_OFFSET;
    529  1.21  reinoud 	exynos_pmu_offset = EXYNOS4_PMU_OFFSET;
    530  1.22  reinoud 	exynos_sysreg_offset = EXYNOS4_SYSREG_OFFSET;
    531  1.21  reinoud 	exynos_cmu_apll_offset = EXYNOS4_CMU_APLL;
    532  1.21  reinoud 
    533  1.21  reinoud 	cpu_freq_settings = cpu_freq_settings_exynos4;
    534  1.21  reinoud 	ncpu_freq_settings = __arraycount(cpu_freq_settings_exynos4);
    535  1.11  reinoud #endif
    536  1.11  reinoud 
    537  1.11  reinoud #ifdef EXYNOS5
    538  1.21  reinoud 	core_size = EXYNOS5_CORE_SIZE;
    539  1.21  reinoud 	audiocore_size = EXYNOS5_AUDIOCORE_SIZE;
    540  1.21  reinoud 	audiocore_pbase = EXYNOS5_AUDIOCORE_PBASE;
    541  1.21  reinoud 	audiocore_vbase = EXYNOS5_AUDIOCORE_VBASE;
    542  1.21  reinoud 	exynos_wdt_offset = EXYNOS5_WDT_OFFSET;
    543  1.21  reinoud 	exynos_pmu_offset = EXYNOS5_PMU_OFFSET;
    544  1.22  reinoud 	exynos_sysreg_offset = EXYNOS5_SYSREG_OFFSET;
    545  1.21  reinoud 	exynos_cmu_apll_offset = EXYNOS5_CMU_APLL;
    546  1.21  reinoud 
    547  1.21  reinoud 	cpu_freq_settings = cpu_freq_settings_exynos5;
    548  1.21  reinoud 	ncpu_freq_settings = __arraycount(cpu_freq_settings_exynos5);
    549  1.11  reinoud #endif
    550   1.1     matt 
    551   1.1     matt 	/* map in the exynos io registers */
    552   1.1     matt 	error = bus_space_map(&exynos_bs_tag, EXYNOS_CORE_PBASE,
    553   1.5  reinoud 		core_size, 0, &exynos_core_bsh);
    554   1.1     matt 	if (error)
    555  1.11  reinoud 		panic("%s: failed to map in Exynos SFR registers: %d",
    556   1.1     matt 			__func__, error);
    557   1.1     matt 	KASSERT(exynos_core_bsh == iobase);
    558   1.7  reinoud 
    559  1.11  reinoud 	error = bus_space_map(&exynos_bs_tag, audiocore_pbase,
    560  1.11  reinoud 		audiocore_size, 0, &exynos_audiocore_bsh);
    561  1.11  reinoud 	if (error)
    562  1.11  reinoud 		panic("%s: failed to map in Exynos audio SFR registers: %d",
    563  1.11  reinoud 			__func__, error);
    564  1.12  reinoud 	KASSERT(exynos_audiocore_bsh == audiocore_vbase);
    565  1.11  reinoud 
    566  1.21  reinoud 	/* map in commonly used subregions and common used register banks */
    567  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_core_bsh,
    568  1.21  reinoud 		exynos_wdt_offset, EXYNOS_BLOCK_SIZE, &exynos_wdt_bsh);
    569  1.21  reinoud 	if (error)
    570  1.21  reinoud 		panic("%s: failed to subregion wdt registers: %d",
    571  1.21  reinoud 			__func__, error);
    572  1.21  reinoud 
    573  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_core_bsh,
    574  1.21  reinoud 		exynos_pmu_offset, EXYNOS_BLOCK_SIZE, &exynos_pmu_bsh);
    575  1.21  reinoud 	if (error)
    576  1.21  reinoud 		panic("%s: failed to subregion pmu registers: %d",
    577  1.21  reinoud 			__func__, error);
    578  1.21  reinoud 
    579  1.21  reinoud 	exynos_cmu_bsh = exynos_core_bsh;
    580  1.22  reinoud 	bus_space_subregion(&exynos_bs_tag, exynos_core_bsh,
    581  1.22  reinoud 		exynos_sysreg_offset, EXYNOS_BLOCK_SIZE,
    582  1.22  reinoud 		&exynos_sysreg_bsh);
    583  1.22  reinoud 	if (error)
    584  1.22  reinoud 		panic("%s: failed to subregion sysreg registers: %d",
    585  1.22  reinoud 			__func__, error);
    586  1.22  reinoud 
    587  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_cmu_bsh,
    588  1.21  reinoud 		exynos_cmu_apll_offset, 0xfff, &exynos_cmu_apll_bsh);
    589  1.21  reinoud 	if (error)
    590  1.21  reinoud 		panic("%s: failed to subregion cmu apll registers: %d",
    591  1.21  reinoud 			__func__, error);
    592  1.21  reinoud 
    593   1.7  reinoud 	/* init bus dma tags */
    594   1.7  reinoud 	exynos_dma_bootstrap(physmem * PAGE_SIZE);
    595   1.8  reinoud 
    596  1.11  reinoud 	/* gpio bootstrapping delayed */
    597   1.1     matt }
    598   1.1     matt 
    599   1.1     matt 
    600   1.1     matt void
    601   1.1     matt exynos_device_register(device_t self, void *aux)
    602   1.1     matt {
    603   1.1     matt 	if (device_is_a(self, "armperiph")
    604   1.1     matt 	    && device_is_a(device_parent(self), "mainbus")) {
    605   1.1     matt 		/*
    606   1.1     matt 		 * XXX KLUDGE ALERT XXX
    607   1.1     matt 		 * The iot mainbus supplies is completely wrong since it scales
    608  1.17      snj 		 * addresses by 2.  The simplest remedy is to replace with our
    609   1.1     matt 		 * bus space used for the armcore regisers (which armperiph uses).
    610   1.1     matt 		 */
    611   1.1     matt 		struct mainbus_attach_args * const mb = aux;
    612   1.1     matt 		mb->mb_iot = &exynos_bs_tag;
    613   1.1     matt 		return;
    614   1.1     matt 	}
    615   1.1     matt 	if (device_is_a(self, "armgic")
    616   1.1     matt 	    && device_is_a(device_parent(self), "armperiph")) {
    617   1.1     matt 		/*
    618   1.1     matt 		 * The Exynos4420 armgic is located at a different location!
    619   1.1     matt 		 */
    620   1.1     matt 
    621   1.1     matt 		extern uint32_t exynos_soc_id;
    622   1.6  reinoud 
    623   1.1     matt 		switch (EXYNOS_PRODUCT_ID(exynos_soc_id)) {
    624  1.21  reinoud #ifdef EXYNOS5
    625   1.1     matt 		case 0xe5410:
    626   1.6  reinoud 			/* offsets not changed on matt's request */
    627   1.1     matt #if 0
    628   1.6  reinoud 			mpcaa->mpcaa_memh = EXYNOS_CORE_VBASE;
    629   1.1     matt 			mpcaa->mpcaa_off1 = EXYNOS5_GIC_IOP_DISTRIBUTOR_OFFSET;
    630   1.1     matt 			mpcaa->mpcaa_off2 = EXYNOS5_GIC_IOP_CONTROLLER_OFFSET;
    631   1.1     matt #endif
    632   1.1     matt 			break;
    633   1.1     matt #endif
    634  1.21  reinoud #ifdef EXYNOS4
    635   1.1     matt 		case 0xe4410:
    636  1.12  reinoud 		case 0xe4412: {
    637  1.12  reinoud 			struct mpcore_attach_args * const mpcaa = aux;
    638  1.12  reinoud 
    639   1.1     matt 			mpcaa->mpcaa_memh = EXYNOS_CORE_VBASE;
    640   1.1     matt 			mpcaa->mpcaa_off1 = EXYNOS4_GIC_DISTRIBUTOR_OFFSET;
    641   1.1     matt 			mpcaa->mpcaa_off2 = EXYNOS4_GIC_CNTR_OFFSET;
    642   1.1     matt 			break;
    643  1.12  reinoud 		      }
    644   1.1     matt #endif
    645   1.1     matt 		default:
    646   1.1     matt 			panic("%s: unknown SoC product id %#x", __func__,
    647   1.1     matt 			    (u_int)EXYNOS_PRODUCT_ID(exynos_soc_id));
    648   1.1     matt 		}
    649   1.1     matt 		return;
    650   1.1     matt 	}
    651  1.10  reinoud 	if (device_is_a(self, "armgtmr") || device_is_a(self, "mct")) {
    652  1.14     matt #ifdef EXYNOS5
    653  1.13     matt 		/*
    654  1.13     matt 		 * The global timer is dependent on the MCT running.
    655  1.13     matt 		 */
    656  1.13     matt 		bus_size_t o = EXYNOS5_MCT_OFFSET + MCT_G_TCON;
    657  1.13     matt 		uint32_t v = bus_space_read_4(&exynos_bs_tag, exynos_core_bsh,
    658  1.14     matt 		     o);
    659  1.13     matt 		v |= G_TCON_START;
    660  1.13     matt 		bus_space_write_4(&exynos_bs_tag, exynos_core_bsh, o, v);
    661  1.13     matt #endif
    662   1.1     matt 		/*
    663  1.10  reinoud 		 * The frequencies of the timers are the reference
    664   1.1     matt 		 * frequency.
    665   1.1     matt 		 */
    666   1.1     matt 		prop_dictionary_set_uint32(device_properties(self),
    667  1.10  reinoud 		    "frequency", EXYNOS_F_IN_FREQ);
    668   1.1     matt 		return;
    669   1.1     matt 	}
    670   1.1     matt 
    671   1.1     matt 	exyo_device_register(self, aux);
    672   1.1     matt }
    673   1.1     matt 
    674   1.9  reinoud 
    675   1.9  reinoud void
    676   1.9  reinoud exynos_device_register_post_config(device_t self, void *aux)
    677   1.9  reinoud {
    678   1.9  reinoud 	exyo_device_register_post_config(self, aux);
    679   1.9  reinoud }
    680   1.9  reinoud 
    681