Home | History | Annotate | Line # | Download | only in samsung
exynos_soc.c revision 1.21
      1  1.21  reinoud /*	$NetBSD: exynos_soc.c,v 1.21 2014/09/29 14:47:52 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.21  reinoud __KERNEL_RCSID(1, "$NetBSD: exynos_soc.c,v 1.21 2014/09/29 14:47:52 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.21  reinoud 
    131  1.21  reinoud 
    132  1.16  reinoud static int sysctl_cpufreq_target(SYSCTLFN_ARGS);
    133  1.16  reinoud static int sysctl_cpufreq_current(SYSCTLFN_ARGS);
    134  1.16  reinoud 
    135   1.1     matt /*
    136   1.1     matt  * the early serial console
    137   1.1     matt  */
    138   1.1     matt #ifdef EXYNOS_CONSOLE_EARLY
    139   1.1     matt 
    140   1.1     matt #include "opt_sscom.h"
    141   1.1     matt #include <arm/samsung/sscom_reg.h>
    142   1.1     matt #include <arm/samsung/sscom_var.h>
    143   1.1     matt #include <dev/cons.h>
    144   1.1     matt 
    145   1.1     matt static volatile uint8_t *uart_base;
    146   1.1     matt 
    147   1.1     matt #define CON_REG(a) (*((volatile uint32_t *)(uart_base + (a))))
    148   1.1     matt 
    149   1.1     matt static int
    150   1.1     matt exynos_cngetc(dev_t dv)
    151   1.1     matt {
    152   1.1     matt         if ((CON_REG(SSCOM_UTRSTAT) & UTRSTAT_RXREADY) == 0)
    153   1.1     matt 		return -1;
    154   1.1     matt 
    155   1.1     matt 	return CON_REG(SSCOM_URXH);
    156   1.1     matt }
    157   1.1     matt 
    158   1.1     matt static void
    159   1.1     matt exynos_cnputc(dev_t dv, int c)
    160   1.1     matt {
    161   1.1     matt 	int timo = 150000;
    162   1.1     matt 
    163   1.1     matt 	while ((CON_REG(SSCOM_UFSTAT) & UFSTAT_TXFULL) && --timo > 0);
    164   1.1     matt 
    165   1.1     matt 	CON_REG(SSCOM_UTXH) = c & 0xff;
    166   1.1     matt }
    167   1.1     matt 
    168   1.1     matt static struct consdev exynos_earlycons = {
    169   1.1     matt 	.cn_putc = exynos_cnputc,
    170   1.1     matt 	.cn_getc = exynos_cngetc,
    171   1.1     matt 	.cn_pollc = nullcnpollc,
    172   1.1     matt };
    173   1.1     matt #endif /* EXYNOS_CONSOLE_EARLY */
    174   1.1     matt 
    175   1.1     matt 
    176   1.1     matt #ifdef ARM_TRUSTZONE_FIRMWARE
    177   1.2  reinoud int
    178   1.1     matt exynos_do_idle(void)
    179   1.1     matt {
    180   1.1     matt         exynos_smc(SMC_CMD_SLEEP, 0, 0, 0);
    181   1.1     matt 
    182   1.1     matt 	return 0;
    183   1.1     matt }
    184   1.1     matt 
    185   1.1     matt 
    186   1.2  reinoud int
    187   1.1     matt exynos_set_cpu_boot_addr(int cpu, vaddr_t boot_addr)
    188   1.1     matt {
    189   1.2  reinoud 	/* XXX we need to map in iRAM space for this XXX */
    190   1.1     matt 	return 0;
    191   1.1     matt }
    192   1.1     matt 
    193   1.1     matt 
    194   1.2  reinoud int
    195   1.1     matt exynos_cpu_boot(int cpu)
    196   1.1     matt {
    197   1.1     matt 	exynos_smc(SMC_CMD_CPU1BOOT, cpu, 0, 0);
    198   1.1     matt 
    199   1.1     matt 	return 0;
    200   1.1     matt }
    201   1.1     matt 
    202   1.1     matt 
    203   1.1     matt /*
    204  1.17      snj  * The latency values used below are `magic' and probably chosen empirically.
    205   1.1     matt  * For the 4210 variant the data latency is lower, a 0x110. This is currently
    206   1.1     matt  * not enforced.
    207   1.1     matt  *
    208   1.1     matt  * The prefetch values are also different for the revision 0 of the
    209   1.1     matt  * Exynos4412, but why?
    210   1.1     matt  */
    211   1.1     matt 
    212   1.2  reinoud int
    213   1.1     matt exynos_l2cc_init(void)
    214   1.1     matt {
    215   1.1     matt 	const uint32_t tag_latency  = 0x110;
    216   1.2  reinoud 	const uint32_t data_latency = IS_EXYNOS4410_P() ? 0x110 : 0x120;
    217   1.1     matt 	const uint32_t prefetch4412   = /* 0111 0001 0000 0000 0000 0000 0000 0111 */
    218   1.1     matt 				PREFETCHCTL_DBLLINEF_EN  |
    219   1.1     matt 				PREFETCHCTL_INSTRPREF_EN |
    220   1.1     matt 				PREFETCHCTL_DATAPREF_EN  |
    221   1.1     matt 				PREFETCHCTL_PREF_DROP_EN |
    222   1.1     matt 				PREFETCHCTL_PREFETCH_OFFSET_7;
    223   1.1     matt 	const uint32_t prefetch4412_r0 = /* 0011 0000 0000 0000 0000 0000 0000 0111 */
    224   1.1     matt 				PREFETCHCTL_INSTRPREF_EN |
    225   1.1     matt 				PREFETCHCTL_DATAPREF_EN  |
    226   1.1     matt 				PREFETCHCTL_PREFETCH_OFFSET_7;
    227   1.1     matt 	const uint32_t aux_val      =    /* 0111 1100 0100 0111 0000 0000 0000 0001 */
    228   1.1     matt 				AUXCTL_EARLY_BRESP_EN |
    229   1.1     matt 				AUXCTL_I_PREFETCH     |
    230   1.1     matt 				AUXCTL_D_PREFETCH     |
    231   1.1     matt 				AUXCTL_NS_INT_ACC_CTL |
    232   1.1     matt 				AUXCTL_NS_INT_LOCK_EN |
    233   1.1     matt 				AUXCTL_SHARED_ATT_OVR |
    234   1.1     matt 				AUXCTL_WAY_SIZE_RSVD7 << 16 | /* why rsvd7 ??? */
    235   1.1     matt 				AUXCTL_FULL_LINE_WR0;
    236   1.1     matt 	const uint32_t aux_keepmask =    /* 1100 0010 0000 0000 1111 1111 1111 1111  */
    237   1.1     matt 				AUXCTL_RSVD31         |
    238   1.1     matt 				AUXCTL_EARLY_BRESP_EN |
    239   1.1     matt 				AUXCTL_CACHE_REPL_RR  |
    240   1.1     matt 
    241   1.1     matt 				AUXCTL_SH_ATTR_INV_ENA|
    242   1.1     matt 				AUXCTL_EXCL_CACHE_CFG |
    243   1.1     matt 				AUXCTL_ST_BUF_DEV_LIM_EN |
    244   1.1     matt 				AUXCTL_HIPRO_SO_DEV_EN |
    245   1.1     matt 				AUXCTL_FULL_LINE_WR0  |
    246   1.1     matt 				0xffff;
    247   1.1     matt 	uint32_t prefetch;
    248   1.1     matt 
    249   1.1     matt 	/* check the bitmaps are the same as the linux implementation uses */
    250   1.1     matt 	KASSERT(prefetch4412    == 0x71000007);
    251   1.1     matt 	KASSERT(prefetch4412_r0 == 0x30000007);
    252   1.1     matt 	KASSERT(aux_val         == 0x7C470001);
    253   1.1     matt 	KASSERT(aux_keepmask    == 0xC200FFFF);
    254   1.1     matt 
    255   1.2  reinoud 	if (IS_EXYNOS4412_R0_P())
    256   1.1     matt 		prefetch = prefetch4412_r0;
    257   1.1     matt 	else
    258   1.1     matt 		prefetch = prefetch4412;	/* newer than >= r1_0 */
    259   1.1     matt 	;
    260   1.1     matt 
    261   1.1     matt 	exynos_smc(SMC_CMD_L2X0SETUP1, tag_latency, data_latency, prefetch);
    262   1.1     matt 	exynos_smc(SMC_CMD_L2X0SETUP2,
    263   1.1     matt 		POWERCTL_DYNCLKGATE | POWERCTL_STANDBY,
    264   1.1     matt 		aux_val, aux_keepmask);
    265   1.1     matt 	exynos_smc(SMC_CMD_L2X0INVALL, 0, 0, 0);
    266   1.1     matt 	exynos_smc(SMC_CMD_L2X0CTRL, 1, 0, 0);
    267   1.1     matt 
    268   1.1     matt 	return 0;
    269   1.1     matt }
    270   1.2  reinoud #endif /* ARM_TRUSTZONE_FIRMWARE */
    271   1.1     matt 
    272   1.1     matt 
    273   1.1     matt void
    274  1.16  reinoud exynos_sysctl_cpufreq_init(void)
    275  1.16  reinoud {
    276  1.16  reinoud 	const struct sysctlnode *node, *cpunode, *freqnode;
    277  1.16  reinoud 	char *cpos;
    278  1.16  reinoud 	int i, val;
    279  1.16  reinoud 	int error;
    280  1.16  reinoud 
    281  1.16  reinoud 	memset(sysctl_cpu_freqs_txt, (int) ' ', sizeof(sysctl_cpu_freqs_txt));
    282  1.16  reinoud 	cpos = sysctl_cpu_freqs_txt;
    283  1.16  reinoud 	for (i = 0; i < ncpu_freq_settings; i++) {
    284  1.16  reinoud 		val = cpu_freq_settings[i].freq;
    285  1.16  reinoud 		snprintf(cpos, 6, "%d ", val);
    286  1.16  reinoud 		cpos += (val < 1000) ? 4 : 5;
    287  1.16  reinoud 	}
    288  1.16  reinoud 	*cpos = 0;
    289  1.16  reinoud 
    290  1.16  reinoud 	error = sysctl_createv(NULL, 0, NULL, &node,
    291  1.16  reinoud 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "machdep", NULL,
    292  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_MACHDEP, CTL_EOL);
    293  1.16  reinoud 	if (error)
    294  1.16  reinoud 		printf("couldn't create `machdep' node\n");
    295  1.16  reinoud 
    296  1.16  reinoud 	error = sysctl_createv(NULL, 0, &node, &cpunode,
    297  1.16  reinoud 	    0, CTLTYPE_NODE, "cpu", NULL,
    298  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
    299  1.16  reinoud 	if (error)
    300  1.16  reinoud 		printf("couldn't create `cpu' node\n");
    301  1.16  reinoud 
    302  1.16  reinoud 	error = sysctl_createv(NULL, 0, &cpunode, &freqnode,
    303  1.16  reinoud 	    0, CTLTYPE_NODE, "frequency", NULL,
    304  1.16  reinoud 	    NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
    305  1.16  reinoud 	if (error)
    306  1.16  reinoud 		printf("couldn't create `frequency' node\n");
    307  1.16  reinoud 
    308  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    309  1.16  reinoud 	    CTLFLAG_READWRITE, CTLTYPE_INT, "target", NULL,
    310  1.16  reinoud 	    sysctl_cpufreq_target, 0, &cpu_freq_target, 0,
    311  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    312  1.16  reinoud 	if (error)
    313  1.16  reinoud 		printf("couldn't create `target' node\n");
    314  1.16  reinoud 
    315  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    316  1.16  reinoud 	    0, CTLTYPE_INT, "current", NULL,
    317  1.16  reinoud 	    sysctl_cpufreq_current, 0, NULL, 0,
    318  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    319  1.16  reinoud 	if (error)
    320  1.16  reinoud 		printf("couldn't create `current' node\n");
    321  1.16  reinoud 
    322  1.16  reinoud 	error = sysctl_createv(NULL, 0, &freqnode, &node,
    323  1.16  reinoud 	    CTLFLAG_READONLY, CTLTYPE_STRING, "available", NULL,
    324  1.16  reinoud 	    NULL, 0, sysctl_cpu_freqs_txt, 0,
    325  1.16  reinoud 	    CTL_CREATE, CTL_EOL);
    326  1.16  reinoud 	if (error)
    327  1.16  reinoud 		printf("couldn't create `available' node\b");
    328  1.16  reinoud }
    329  1.16  reinoud 
    330  1.16  reinoud 
    331  1.16  reinoud uint64_t
    332  1.16  reinoud exynos_get_cpufreq(void)
    333  1.16  reinoud {
    334  1.16  reinoud 	uint32_t regval;
    335  1.16  reinoud 	uint32_t freq;
    336  1.16  reinoud 
    337  1.21  reinoud 	regval = bus_space_read_4(&exynos_bs_tag, exynos_cmu_apll_bsh,
    338  1.21  reinoud 			PLL_CON0_OFFSET);
    339  1.16  reinoud 	freq   = PLL_FREQ(EXYNOS_F_IN_FREQ, regval);
    340  1.16  reinoud 
    341  1.16  reinoud 	return freq;
    342  1.16  reinoud }
    343  1.16  reinoud 
    344  1.16  reinoud 
    345  1.16  reinoud static void
    346  1.16  reinoud exynos_set_cpufreq(const struct cpu_freq *freqreq)
    347  1.16  reinoud {
    348  1.18  reinoud 	struct cpu_info *ci;
    349  1.16  reinoud 	uint32_t regval;
    350  1.16  reinoud 	int M, P, S;
    351  1.18  reinoud 	int cii;
    352  1.16  reinoud 
    353  1.16  reinoud 	M = freqreq->M;
    354  1.16  reinoud 	P = freqreq->P;
    355  1.16  reinoud 	S = freqreq->S;
    356  1.16  reinoud 
    357  1.16  reinoud 	regval = __SHIFTIN(M, PLL_CON0_M) |
    358  1.16  reinoud 		 __SHIFTIN(P, PLL_CON0_P) |
    359  1.16  reinoud 		 __SHIFTIN(S, PLL_CON0_S);
    360  1.16  reinoud 
    361  1.16  reinoud 	/* enable PPL and write config */
    362  1.16  reinoud 	regval |= PLL_CON0_ENABLE;
    363  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_cmu_apll_bsh, PLL_CON0_OFFSET,
    364  1.21  reinoud 		regval);
    365  1.18  reinoud 
    366  1.18  reinoud 	/* update our cycle counter i.e. our CPU frequency for all CPUs */
    367  1.18  reinoud 	for (CPU_INFO_FOREACH(cii, ci)) {
    368  1.18  reinoud 		ci->ci_data.cpu_cc_freq = exynos_get_cpufreq();
    369  1.18  reinoud 	}
    370  1.16  reinoud }
    371  1.16  reinoud 
    372  1.16  reinoud 
    373  1.16  reinoud static int
    374  1.16  reinoud sysctl_cpufreq_target(SYSCTLFN_ARGS)
    375  1.16  reinoud {
    376  1.16  reinoud 	struct sysctlnode node;
    377  1.16  reinoud 	uint32_t t, curfreq, minfreq, maxfreq;
    378  1.16  reinoud 	int i, best_i, diff;
    379  1.16  reinoud 	int error;
    380  1.16  reinoud 
    381  1.16  reinoud 	curfreq = exynos_get_cpufreq() / (1000*1000);
    382  1.16  reinoud 	t = *(int *)rnode->sysctl_data;
    383  1.16  reinoud 	if (t == 0)
    384  1.16  reinoud 		t = curfreq;
    385  1.16  reinoud 
    386  1.16  reinoud 	node = *rnode;
    387  1.16  reinoud 	node.sysctl_data = &t;
    388  1.16  reinoud 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
    389  1.16  reinoud 	if (error || newp == NULL)
    390  1.16  reinoud 		return error;
    391  1.16  reinoud 
    392  1.16  reinoud 	minfreq = cpu_freq_settings[0].freq;
    393  1.16  reinoud 	maxfreq = cpu_freq_settings[ncpu_freq_settings-1].freq;
    394  1.16  reinoud 
    395  1.16  reinoud 	if ((t < minfreq) || (t > maxfreq))
    396  1.16  reinoud 		return EINVAL;
    397  1.16  reinoud 
    398  1.16  reinoud 	if (t == curfreq) {
    399  1.16  reinoud 		*(int *)rnode->sysctl_data = t;
    400  1.16  reinoud 		return 0;
    401  1.16  reinoud 	}
    402  1.16  reinoud 
    403  1.16  reinoud 	diff = maxfreq;
    404  1.16  reinoud 	best_i = -1;
    405  1.16  reinoud 	for (i = 0; i < ncpu_freq_settings; i++) {
    406  1.16  reinoud 		if (abs(t - cpu_freq_settings[i].freq) <= diff) {
    407  1.16  reinoud 			diff = labs(t - cpu_freq_settings[i].freq);
    408  1.16  reinoud 			best_i = i;
    409  1.16  reinoud 		}
    410  1.16  reinoud 	}
    411  1.16  reinoud 	if (best_i < 0)
    412  1.16  reinoud 		return EINVAL;
    413  1.16  reinoud 
    414  1.16  reinoud 	exynos_set_cpufreq(&cpu_freq_settings[best_i]);
    415  1.16  reinoud 
    416  1.16  reinoud 	*(int *)rnode->sysctl_data = t;
    417  1.16  reinoud 	return 0;
    418  1.16  reinoud }
    419  1.16  reinoud 
    420  1.16  reinoud 
    421  1.16  reinoud static int
    422  1.16  reinoud sysctl_cpufreq_current(SYSCTLFN_ARGS)
    423  1.16  reinoud {
    424  1.16  reinoud 	struct sysctlnode node = *rnode;
    425  1.16  reinoud 	uint32_t freq;
    426  1.16  reinoud 
    427  1.16  reinoud 	freq = exynos_get_cpufreq() / (1000*1000);
    428  1.16  reinoud 	node.sysctl_data = &freq;
    429  1.16  reinoud 
    430  1.16  reinoud 	return sysctl_lookup(SYSCTLFN_CALL(&node));
    431  1.16  reinoud }
    432  1.16  reinoud 
    433  1.16  reinoud 
    434  1.19  reinoud #ifdef VERBOSE_INIT_ARM
    435  1.19  reinoud #define DUMP_PLL(v, var) \
    436  1.19  reinoud 	reg = EXYNOS##v##_CMU_##var + PLL_CON0_OFFSET;\
    437  1.21  reinoud 	regval = bus_space_read_4(&exynos_bs_tag, exynos_cmu_bsh, reg); \
    438  1.19  reinoud 	freq   = PLL_FREQ(EXYNOS_F_IN_FREQ, regval); \
    439  1.19  reinoud 	printf("%8s at %d Mhz\n", #var, freq/(1000*1000));
    440  1.19  reinoud 
    441  1.19  reinoud 
    442  1.19  reinoud static void
    443  1.19  reinoud exynos_dump_clocks(void)
    444  1.19  reinoud {
    445  1.19  reinoud 	uint32_t reg = 0;
    446  1.19  reinoud 	uint32_t regval;
    447  1.19  reinoud 	uint32_t freq;
    448  1.19  reinoud 
    449  1.19  reinoud 	printf("Initial PLL settings\n");
    450  1.19  reinoud #ifdef EXYNOS4
    451  1.21  reinoud 	DUMP_PLL(4, APLL);
    452  1.21  reinoud 	DUMP_PLL(4, MPLL);
    453  1.21  reinoud 	DUMP_PLL(4, EPLL);
    454  1.21  reinoud 	DUMP_PLL(4, VPLL);
    455  1.19  reinoud #endif
    456  1.19  reinoud #ifdef EXYNOS5
    457  1.21  reinoud 	DUMP_PLL(5, APLL);
    458  1.21  reinoud 	DUMP_PLL(5, MPLL);
    459  1.21  reinoud 	DUMP_PLL(5, EPLL);
    460  1.21  reinoud 	DUMP_PLL(5, VPLL);
    461  1.21  reinoud 	DUMP_PLL(5, CPLL);
    462  1.21  reinoud 	DUMP_PLL(5, GPLL);
    463  1.21  reinoud 	DUMP_PLL(5, BPLL);
    464  1.19  reinoud #endif
    465  1.19  reinoud }
    466  1.19  reinoud #undef DUMP_PLL
    467  1.19  reinoud #endif
    468  1.19  reinoud 
    469  1.19  reinoud 
    470  1.21  reinoud /* XXX clock stuff needs major work XXX */
    471  1.21  reinoud static void
    472  1.21  reinoud exynos_init_clkout_for_usb(void)
    473  1.16  reinoud {
    474  1.16  reinoud #ifdef EXYNOS4
    475  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_pmu_bsh,
    476  1.21  reinoud 		EXYNOS_PMU_DEBUG_CLKOUT, 0x900);
    477  1.16  reinoud #endif
    478  1.16  reinoud #ifdef EXYNOS5
    479  1.21  reinoud 	bus_space_write_4(&exynos_bs_tag, exynos_pmu_bsh,
    480  1.21  reinoud 		EXYNOS_PMU_DEBUG_CLKOUT, 0x1000);
    481  1.16  reinoud #endif
    482  1.21  reinoud }
    483  1.21  reinoud 
    484  1.21  reinoud 
    485  1.21  reinoud void
    486  1.21  reinoud exynos_clocks_bootstrap(void)
    487  1.21  reinoud {
    488  1.16  reinoud 	KASSERT(ncpu_freq_settings != 0);
    489  1.16  reinoud 	KASSERT(ncpu_freq_settings < NFRQS);
    490  1.16  reinoud 
    491  1.19  reinoud #ifdef VERBOSE_INIT_ARM
    492  1.19  reinoud 	exynos_dump_clocks();
    493  1.19  reinoud #endif
    494  1.19  reinoud 
    495  1.16  reinoud 	/* set max cpufreq */
    496  1.16  reinoud 	exynos_set_cpufreq(&cpu_freq_settings[ncpu_freq_settings-1]);
    497  1.21  reinoud 
    498  1.21  reinoud 	/* set external USB frequency to XCLKOUT */
    499  1.21  reinoud 	exynos_init_clkout_for_usb();
    500  1.16  reinoud }
    501  1.16  reinoud 
    502  1.16  reinoud 
    503  1.16  reinoud void
    504   1.1     matt exynos_bootstrap(vaddr_t iobase, vaddr_t uartbase)
    505   1.1     matt {
    506   1.5  reinoud 	int error;
    507  1.11  reinoud 	size_t core_size, audiocore_size;
    508  1.21  reinoud 	bus_addr_t audiocore_pbase;
    509  1.21  reinoud 	bus_addr_t audiocore_vbase __diagused;
    510  1.21  reinoud 	bus_addr_t exynos_wdt_offset;
    511  1.21  reinoud 	bus_addr_t exynos_pmu_offset;
    512  1.21  reinoud 	bus_addr_t exynos_cmu_apll_offset;
    513  1.21  reinoud 
    514  1.21  reinoud 	/* set up early console so we can use printf() and friends */
    515  1.21  reinoud #ifdef EXYNOS_CONSOLE_EARLY
    516  1.21  reinoud 	uart_base = (volatile uint8_t *) uartbase;
    517  1.21  reinoud 	cn_tab = &exynos_earlycons;
    518  1.21  reinoud 	printf("Exynos early console operational\n\n");
    519  1.21  reinoud #endif
    520  1.11  reinoud 
    521  1.11  reinoud #ifdef EXYNOS4
    522  1.21  reinoud 	core_size = EXYNOS4_CORE_SIZE;
    523  1.21  reinoud 	audiocore_size = EXYNOS4_AUDIOCORE_SIZE;
    524  1.21  reinoud 	audiocore_pbase = EXYNOS4_AUDIOCORE_PBASE;
    525  1.21  reinoud 	audiocore_vbase = EXYNOS4_AUDIOCORE_VBASE;
    526  1.21  reinoud 	exynos_wdt_offset = EXYNOS4_WDT_OFFSET;
    527  1.21  reinoud 	exynos_pmu_offset = EXYNOS4_PMU_OFFSET;
    528  1.21  reinoud 	exynos_cmu_apll_offset = EXYNOS4_CMU_APLL;
    529  1.21  reinoud 
    530  1.21  reinoud 	cpu_freq_settings = cpu_freq_settings_exynos4;
    531  1.21  reinoud 	ncpu_freq_settings = __arraycount(cpu_freq_settings_exynos4);
    532  1.11  reinoud #endif
    533  1.11  reinoud 
    534  1.11  reinoud #ifdef EXYNOS5
    535  1.21  reinoud 	core_size = EXYNOS5_CORE_SIZE;
    536  1.21  reinoud 	audiocore_size = EXYNOS5_AUDIOCORE_SIZE;
    537  1.21  reinoud 	audiocore_pbase = EXYNOS5_AUDIOCORE_PBASE;
    538  1.21  reinoud 	audiocore_vbase = EXYNOS5_AUDIOCORE_VBASE;
    539  1.21  reinoud 	exynos_wdt_offset = EXYNOS5_WDT_OFFSET;
    540  1.21  reinoud 	exynos_pmu_offset = EXYNOS5_PMU_OFFSET;
    541  1.21  reinoud 	exynos_cmu_apll_offset = EXYNOS5_CMU_APLL;
    542  1.21  reinoud 
    543  1.21  reinoud 	cpu_freq_settings = cpu_freq_settings_exynos5;
    544  1.21  reinoud 	ncpu_freq_settings = __arraycount(cpu_freq_settings_exynos5);
    545  1.11  reinoud #endif
    546   1.1     matt 
    547   1.1     matt 	/* map in the exynos io registers */
    548   1.1     matt 	error = bus_space_map(&exynos_bs_tag, EXYNOS_CORE_PBASE,
    549   1.5  reinoud 		core_size, 0, &exynos_core_bsh);
    550   1.1     matt 	if (error)
    551  1.11  reinoud 		panic("%s: failed to map in Exynos SFR registers: %d",
    552   1.1     matt 			__func__, error);
    553   1.1     matt 	KASSERT(exynos_core_bsh == iobase);
    554   1.7  reinoud 
    555  1.11  reinoud 	error = bus_space_map(&exynos_bs_tag, audiocore_pbase,
    556  1.11  reinoud 		audiocore_size, 0, &exynos_audiocore_bsh);
    557  1.11  reinoud 	if (error)
    558  1.11  reinoud 		panic("%s: failed to map in Exynos audio SFR registers: %d",
    559  1.11  reinoud 			__func__, error);
    560  1.12  reinoud 	KASSERT(exynos_audiocore_bsh == audiocore_vbase);
    561  1.11  reinoud 
    562  1.21  reinoud 	/* map in commonly used subregions and common used register banks */
    563  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_core_bsh,
    564  1.21  reinoud 		exynos_wdt_offset, EXYNOS_BLOCK_SIZE, &exynos_wdt_bsh);
    565  1.21  reinoud 	if (error)
    566  1.21  reinoud 		panic("%s: failed to subregion wdt registers: %d",
    567  1.21  reinoud 			__func__, error);
    568  1.21  reinoud 
    569  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_core_bsh,
    570  1.21  reinoud 		exynos_pmu_offset, EXYNOS_BLOCK_SIZE, &exynos_pmu_bsh);
    571  1.21  reinoud 	if (error)
    572  1.21  reinoud 		panic("%s: failed to subregion pmu registers: %d",
    573  1.21  reinoud 			__func__, error);
    574  1.21  reinoud 
    575  1.21  reinoud 	exynos_cmu_bsh = exynos_core_bsh;
    576  1.21  reinoud 	error = bus_space_subregion(&exynos_bs_tag, exynos_cmu_bsh,
    577  1.21  reinoud 		exynos_cmu_apll_offset, 0xfff, &exynos_cmu_apll_bsh);
    578  1.21  reinoud 	if (error)
    579  1.21  reinoud 		panic("%s: failed to subregion cmu apll registers: %d",
    580  1.21  reinoud 			__func__, error);
    581  1.21  reinoud 
    582   1.7  reinoud 	/* init bus dma tags */
    583   1.7  reinoud 	exynos_dma_bootstrap(physmem * PAGE_SIZE);
    584   1.8  reinoud 
    585  1.11  reinoud 	/* gpio bootstrapping delayed */
    586   1.1     matt }
    587   1.1     matt 
    588   1.1     matt 
    589   1.1     matt void
    590   1.1     matt exynos_device_register(device_t self, void *aux)
    591   1.1     matt {
    592   1.1     matt 	if (device_is_a(self, "armperiph")
    593   1.1     matt 	    && device_is_a(device_parent(self), "mainbus")) {
    594   1.1     matt 		/*
    595   1.1     matt 		 * XXX KLUDGE ALERT XXX
    596   1.1     matt 		 * The iot mainbus supplies is completely wrong since it scales
    597  1.17      snj 		 * addresses by 2.  The simplest remedy is to replace with our
    598   1.1     matt 		 * bus space used for the armcore regisers (which armperiph uses).
    599   1.1     matt 		 */
    600   1.1     matt 		struct mainbus_attach_args * const mb = aux;
    601   1.1     matt 		mb->mb_iot = &exynos_bs_tag;
    602   1.1     matt 		return;
    603   1.1     matt 	}
    604   1.1     matt 	if (device_is_a(self, "armgic")
    605   1.1     matt 	    && device_is_a(device_parent(self), "armperiph")) {
    606   1.1     matt 		/*
    607   1.1     matt 		 * The Exynos4420 armgic is located at a different location!
    608   1.1     matt 		 */
    609   1.1     matt 
    610   1.1     matt 		extern uint32_t exynos_soc_id;
    611   1.6  reinoud 
    612   1.1     matt 		switch (EXYNOS_PRODUCT_ID(exynos_soc_id)) {
    613  1.21  reinoud #ifdef EXYNOS5
    614   1.1     matt 		case 0xe5410:
    615   1.6  reinoud 			/* offsets not changed on matt's request */
    616   1.1     matt #if 0
    617   1.6  reinoud 			mpcaa->mpcaa_memh = EXYNOS_CORE_VBASE;
    618   1.1     matt 			mpcaa->mpcaa_off1 = EXYNOS5_GIC_IOP_DISTRIBUTOR_OFFSET;
    619   1.1     matt 			mpcaa->mpcaa_off2 = EXYNOS5_GIC_IOP_CONTROLLER_OFFSET;
    620   1.1     matt #endif
    621   1.1     matt 			break;
    622   1.1     matt #endif
    623  1.21  reinoud #ifdef EXYNOS4
    624   1.1     matt 		case 0xe4410:
    625  1.12  reinoud 		case 0xe4412: {
    626  1.12  reinoud 			struct mpcore_attach_args * const mpcaa = aux;
    627  1.12  reinoud 
    628   1.1     matt 			mpcaa->mpcaa_memh = EXYNOS_CORE_VBASE;
    629   1.1     matt 			mpcaa->mpcaa_off1 = EXYNOS4_GIC_DISTRIBUTOR_OFFSET;
    630   1.1     matt 			mpcaa->mpcaa_off2 = EXYNOS4_GIC_CNTR_OFFSET;
    631   1.1     matt 			break;
    632  1.12  reinoud 		      }
    633   1.1     matt #endif
    634   1.1     matt 		default:
    635   1.1     matt 			panic("%s: unknown SoC product id %#x", __func__,
    636   1.1     matt 			    (u_int)EXYNOS_PRODUCT_ID(exynos_soc_id));
    637   1.1     matt 		}
    638   1.1     matt 		return;
    639   1.1     matt 	}
    640  1.10  reinoud 	if (device_is_a(self, "armgtmr") || device_is_a(self, "mct")) {
    641  1.14     matt #ifdef EXYNOS5
    642  1.13     matt 		/*
    643  1.13     matt 		 * The global timer is dependent on the MCT running.
    644  1.13     matt 		 */
    645  1.13     matt 		bus_size_t o = EXYNOS5_MCT_OFFSET + MCT_G_TCON;
    646  1.13     matt 		uint32_t v = bus_space_read_4(&exynos_bs_tag, exynos_core_bsh,
    647  1.14     matt 		     o);
    648  1.13     matt 		v |= G_TCON_START;
    649  1.13     matt 		bus_space_write_4(&exynos_bs_tag, exynos_core_bsh, o, v);
    650  1.13     matt #endif
    651   1.1     matt 		/*
    652  1.10  reinoud 		 * The frequencies of the timers are the reference
    653   1.1     matt 		 * frequency.
    654   1.1     matt 		 */
    655   1.1     matt 		prop_dictionary_set_uint32(device_properties(self),
    656  1.10  reinoud 		    "frequency", EXYNOS_F_IN_FREQ);
    657   1.1     matt 		return;
    658   1.1     matt 	}
    659   1.1     matt 
    660   1.1     matt 	exyo_device_register(self, aux);
    661   1.1     matt }
    662   1.1     matt 
    663   1.9  reinoud 
    664   1.9  reinoud void
    665   1.9  reinoud exynos_device_register_post_config(device_t self, void *aux)
    666   1.9  reinoud {
    667   1.9  reinoud 	exyo_device_register_post_config(self, aux);
    668   1.9  reinoud }
    669   1.9  reinoud 
    670