116694521SOleksandr Tymoshenko /*- 216694521SOleksandr Tymoshenko * Copyright (c) 2011 Semihalf. 316694521SOleksandr Tymoshenko * All rights reserved. 416694521SOleksandr Tymoshenko * 516694521SOleksandr Tymoshenko * Redistribution and use in source and binary forms, with or without 616694521SOleksandr Tymoshenko * modification, are permitted provided that the following conditions 716694521SOleksandr Tymoshenko * are met: 816694521SOleksandr Tymoshenko * 1. Redistributions of source code must retain the above copyright 916694521SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer. 1016694521SOleksandr Tymoshenko * 2. Redistributions in binary form must reproduce the above copyright 1116694521SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer in the 1216694521SOleksandr Tymoshenko * documentation and/or other materials provided with the distribution. 1316694521SOleksandr Tymoshenko * 1416694521SOleksandr Tymoshenko * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1516694521SOleksandr Tymoshenko * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1616694521SOleksandr Tymoshenko * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1716694521SOleksandr Tymoshenko * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1816694521SOleksandr Tymoshenko * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1916694521SOleksandr Tymoshenko * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2016694521SOleksandr Tymoshenko * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2116694521SOleksandr Tymoshenko * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2216694521SOleksandr Tymoshenko * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2316694521SOleksandr Tymoshenko * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2416694521SOleksandr Tymoshenko * SUCH DAMAGE. 2516694521SOleksandr Tymoshenko * 2616694521SOleksandr Tymoshenko * From: FreeBSD: src/sys/arm/mv/kirkwood/sheevaplug.c,v 1.2 2010/06/13 13:28:53 2716694521SOleksandr Tymoshenko */ 2816694521SOleksandr Tymoshenko 2916694521SOleksandr Tymoshenko #include <sys/cdefs.h> 3016694521SOleksandr Tymoshenko __FBSDID("$FreeBSD$"); 3116694521SOleksandr Tymoshenko 3216694521SOleksandr Tymoshenko #include <sys/param.h> 3316694521SOleksandr Tymoshenko #include <sys/systm.h> 3416694521SOleksandr Tymoshenko #include <sys/bus.h> 3516694521SOleksandr Tymoshenko 3616694521SOleksandr Tymoshenko #include <machine/bus.h> 37d65cdf4bSGrzegorz Bernacki #include <machine/armreg.h> 3816694521SOleksandr Tymoshenko 393a1f2172SGrzegorz Bernacki #include <arm/mv/mvwin.h> 4016694521SOleksandr Tymoshenko #include <arm/mv/mvreg.h> 4116694521SOleksandr Tymoshenko #include <arm/mv/mvvar.h> 4216694521SOleksandr Tymoshenko 4316694521SOleksandr Tymoshenko #include <dev/fdt/fdt_common.h> 4416694521SOleksandr Tymoshenko #include <dev/ofw/openfirm.h> 4516694521SOleksandr Tymoshenko 4616694521SOleksandr Tymoshenko #include <machine/fdt.h> 4716694521SOleksandr Tymoshenko 48d65cdf4bSGrzegorz Bernacki #define CPU_FREQ_FIELD(sar) (((0x01 & (sar >> 52)) << 3) | \ 49d65cdf4bSGrzegorz Bernacki (0x07 & (sar >> 21))) 50d65cdf4bSGrzegorz Bernacki #define FAB_FREQ_FIELD(sar) (((0x01 & (sar >> 51)) << 4) | \ 51d65cdf4bSGrzegorz Bernacki (0x0F & (sar >> 24))) 52d65cdf4bSGrzegorz Bernacki 53d65cdf4bSGrzegorz Bernacki static uint32_t count_l2clk(void); 54d65cdf4bSGrzegorz Bernacki 553a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_BASE (MV_BASE + 0x8000) 563a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CTRL 0x100 573a1f2172SGrzegorz Bernacki #define L2_ENABLE (1 << 0) 583a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_AUX_CTRL 0x104 593a1f2172SGrzegorz Bernacki #define L2_WBWT_MODE_MASK (3 << 0) 603a1f2172SGrzegorz Bernacki #define L2_WBWT_MODE_PAGE 0 613a1f2172SGrzegorz Bernacki #define L2_WBWT_MODE_WB 1 623a1f2172SGrzegorz Bernacki #define L2_WBWT_MODE_WT 2 633a1f2172SGrzegorz Bernacki #define L2_REP_STRAT_MASK (3 << 27) 643a1f2172SGrzegorz Bernacki #define L2_REP_STRAT_LSFR (1 << 27) 653a1f2172SGrzegorz Bernacki #define L2_REP_STRAT_SEMIPLRU (3 << 27) 663a1f2172SGrzegorz Bernacki 673a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CNTR_CTRL 0x200 683a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CNTR_CONF(x) (0x204 + (x) * 0xc) 693a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CNTR2_VAL_LOW (0x208 + (x) * 0xc) 703a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CNTR2_VAL_HI (0x20c + (x) * 0xc) 713a1f2172SGrzegorz Bernacki 723a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_INT_CAUSE 0x220 733a1f2172SGrzegorz Bernacki 743a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_SYNC_BARRIER 0x700 753a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_INV_WAY 0x778 763a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_CLEAN_WAY 0x7BC 773a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_FLUSH_PHYS 0x7F0 783a1f2172SGrzegorz Bernacki #define ARMADAXP_L2_FLUSH_WAY 0x7FC 793a1f2172SGrzegorz Bernacki 803a1f2172SGrzegorz Bernacki #define COHER_FABRIC_CFU 0x228 813a1f2172SGrzegorz Bernacki 82d65cdf4bSGrzegorz Bernacki /* XXX Make gpio driver optional and remove it */ 8316694521SOleksandr Tymoshenko struct resource_spec mv_gpio_res[] = { 8416694521SOleksandr Tymoshenko { SYS_RES_MEMORY, 0, RF_ACTIVE }, 8516694521SOleksandr Tymoshenko { SYS_RES_IRQ, 0, RF_ACTIVE }, 8616694521SOleksandr Tymoshenko { -1, 0 } 8716694521SOleksandr Tymoshenko }; 8816694521SOleksandr Tymoshenko 89d65cdf4bSGrzegorz Bernacki struct vco_freq_ratio { 90d65cdf4bSGrzegorz Bernacki uint8_t vco_cpu; /* VCO to CLK0(CPU) clock ratio */ 91d65cdf4bSGrzegorz Bernacki uint8_t vco_l2c; /* VCO to NB(L2 cache) clock ratio */ 92d65cdf4bSGrzegorz Bernacki uint8_t vco_hcl; /* VCO to HCLK(DDR controller) clock ratio */ 93d65cdf4bSGrzegorz Bernacki uint8_t vco_ddr; /* VCO to DR(DDR memory) clock ratio */ 94d65cdf4bSGrzegorz Bernacki }; 95d65cdf4bSGrzegorz Bernacki 96d65cdf4bSGrzegorz Bernacki static struct vco_freq_ratio freq_conf_table[] = { 97d65cdf4bSGrzegorz Bernacki /*00*/ { 1, 1, 4, 2 }, 98d65cdf4bSGrzegorz Bernacki /*01*/ { 1, 2, 2, 2 }, 99d65cdf4bSGrzegorz Bernacki /*02*/ { 2, 2, 6, 3 }, 100d65cdf4bSGrzegorz Bernacki /*03*/ { 2, 2, 3, 3 }, 101d65cdf4bSGrzegorz Bernacki /*04*/ { 1, 2, 3, 3 }, 102d65cdf4bSGrzegorz Bernacki /*05*/ { 1, 2, 4, 2 }, 103d65cdf4bSGrzegorz Bernacki /*06*/ { 1, 1, 2, 2 }, 104d65cdf4bSGrzegorz Bernacki /*07*/ { 2, 3, 6, 6 }, 105d65cdf4bSGrzegorz Bernacki /*08*/ { 2, 3, 5, 5 }, 106d65cdf4bSGrzegorz Bernacki /*09*/ { 1, 2, 6, 3 }, 107d65cdf4bSGrzegorz Bernacki /*10*/ { 2, 4, 10, 5 }, 108d65cdf4bSGrzegorz Bernacki /*11*/ { 1, 3, 6, 6 }, 109d65cdf4bSGrzegorz Bernacki /*12*/ { 1, 2, 5, 5 }, 110d65cdf4bSGrzegorz Bernacki /*13*/ { 1, 3, 6, 3 }, 111d65cdf4bSGrzegorz Bernacki /*14*/ { 1, 2, 5, 5 }, 112d65cdf4bSGrzegorz Bernacki /*15*/ { 2, 2, 5, 5 }, 113d65cdf4bSGrzegorz Bernacki /*16*/ { 1, 1, 3, 3 }, 114d65cdf4bSGrzegorz Bernacki /*17*/ { 2, 5, 10, 10 }, 115d65cdf4bSGrzegorz Bernacki /*18*/ { 1, 3, 8, 4 }, 116d65cdf4bSGrzegorz Bernacki /*19*/ { 1, 1, 2, 1 }, 117d65cdf4bSGrzegorz Bernacki /*20*/ { 2, 3, 6, 3 }, 118d65cdf4bSGrzegorz Bernacki /*21*/ { 1, 2, 8, 4 }, 119d65cdf4bSGrzegorz Bernacki /*22*/ { 2, 5, 10, 5 } 120d65cdf4bSGrzegorz Bernacki }; 121d65cdf4bSGrzegorz Bernacki 122d65cdf4bSGrzegorz Bernacki static uint16_t cpu_clock_table[] = { 123d65cdf4bSGrzegorz Bernacki 1000, 1066, 1200, 1333, 1500, 1666, 1800, 2000, 600, 667, 800, 1600, 124d65cdf4bSGrzegorz Bernacki 2133, 2200, 2400 }; 125d65cdf4bSGrzegorz Bernacki 12616694521SOleksandr Tymoshenko uint32_t 12716694521SOleksandr Tymoshenko get_tclk(void) 12816694521SOleksandr Tymoshenko { 129d65cdf4bSGrzegorz Bernacki uint32_t cputype; 13016694521SOleksandr Tymoshenko 131d65cdf4bSGrzegorz Bernacki cputype = cpufunc_id(); 132d65cdf4bSGrzegorz Bernacki cputype &= CPU_ID_CPU_MASK; 133d65cdf4bSGrzegorz Bernacki 134d65cdf4bSGrzegorz Bernacki if (cputype == CPU_ID_MV88SV584X_V7) 135d65cdf4bSGrzegorz Bernacki return (TCLK_250MHZ); 136d65cdf4bSGrzegorz Bernacki else 13716694521SOleksandr Tymoshenko return (TCLK_200MHZ); 13816694521SOleksandr Tymoshenko } 13916694521SOleksandr Tymoshenko 140d65cdf4bSGrzegorz Bernacki static uint32_t 141d65cdf4bSGrzegorz Bernacki count_l2clk(void) 142d65cdf4bSGrzegorz Bernacki { 143d65cdf4bSGrzegorz Bernacki uint64_t sar_reg; 144d65cdf4bSGrzegorz Bernacki uint32_t freq_vco, freq_l2clk; 145d65cdf4bSGrzegorz Bernacki uint8_t sar_cpu_freq, sar_fab_freq, array_size; 146d65cdf4bSGrzegorz Bernacki 147d65cdf4bSGrzegorz Bernacki /* Get value of the SAR register and process it */ 148d65cdf4bSGrzegorz Bernacki sar_reg = get_sar_value(); 149d65cdf4bSGrzegorz Bernacki sar_cpu_freq = CPU_FREQ_FIELD(sar_reg); 150d65cdf4bSGrzegorz Bernacki sar_fab_freq = FAB_FREQ_FIELD(sar_reg); 151d65cdf4bSGrzegorz Bernacki 152d65cdf4bSGrzegorz Bernacki /* Check if CPU frequency field has correct value */ 153d65cdf4bSGrzegorz Bernacki array_size = sizeof(cpu_clock_table) / sizeof(cpu_clock_table[0]); 154d65cdf4bSGrzegorz Bernacki if (sar_cpu_freq >= array_size) 155d65cdf4bSGrzegorz Bernacki panic("Reserved value in cpu frequency configuration field: " 156d65cdf4bSGrzegorz Bernacki "%d", sar_cpu_freq); 157d65cdf4bSGrzegorz Bernacki 158d65cdf4bSGrzegorz Bernacki /* Check if fabric frequency field has correct value */ 159d65cdf4bSGrzegorz Bernacki array_size = sizeof(freq_conf_table) / sizeof(freq_conf_table[0]); 160d65cdf4bSGrzegorz Bernacki if (sar_fab_freq >= array_size) 161d65cdf4bSGrzegorz Bernacki panic("Reserved value in fabric frequency configuration field: " 162d65cdf4bSGrzegorz Bernacki "%d", sar_fab_freq); 163d65cdf4bSGrzegorz Bernacki 164d65cdf4bSGrzegorz Bernacki /* Get CPU clock frequency */ 165d65cdf4bSGrzegorz Bernacki freq_vco = cpu_clock_table[sar_cpu_freq] * 166d65cdf4bSGrzegorz Bernacki freq_conf_table[sar_fab_freq].vco_cpu; 167d65cdf4bSGrzegorz Bernacki 168d65cdf4bSGrzegorz Bernacki /* Get L2CLK clock frequency */ 169d65cdf4bSGrzegorz Bernacki freq_l2clk = freq_vco / freq_conf_table[sar_fab_freq].vco_l2c; 170d65cdf4bSGrzegorz Bernacki 171d65cdf4bSGrzegorz Bernacki /* Round L2CLK value to integer MHz */ 172d65cdf4bSGrzegorz Bernacki if (((freq_vco % freq_conf_table[sar_fab_freq].vco_l2c) * 10 / 173d65cdf4bSGrzegorz Bernacki freq_conf_table[sar_fab_freq].vco_l2c) >= 5) 174d65cdf4bSGrzegorz Bernacki freq_l2clk++; 175d65cdf4bSGrzegorz Bernacki 176d65cdf4bSGrzegorz Bernacki return (freq_l2clk * 1000000); 177d65cdf4bSGrzegorz Bernacki } 178d65cdf4bSGrzegorz Bernacki 17916694521SOleksandr Tymoshenko uint32_t 18016694521SOleksandr Tymoshenko get_l2clk(void) 18116694521SOleksandr Tymoshenko { 182d65cdf4bSGrzegorz Bernacki static uint32_t l2clk_freq = 0; 18316694521SOleksandr Tymoshenko 184d65cdf4bSGrzegorz Bernacki /* If get_l2clk is called first time get L2CLK value from register */ 185d65cdf4bSGrzegorz Bernacki if (l2clk_freq == 0) 186d65cdf4bSGrzegorz Bernacki l2clk_freq = count_l2clk(); 187d65cdf4bSGrzegorz Bernacki 188d65cdf4bSGrzegorz Bernacki return (l2clk_freq); 18916694521SOleksandr Tymoshenko } 19016694521SOleksandr Tymoshenko 1913a1f2172SGrzegorz Bernacki void armadaxp_l2_init(void); 1923a1f2172SGrzegorz Bernacki void armadaxp_l2_idcache_inv_all(void); 1933a1f2172SGrzegorz Bernacki 1943a1f2172SGrzegorz Bernacki #define ALL_WAYS 0xffffffff 1953a1f2172SGrzegorz Bernacki 1963a1f2172SGrzegorz Bernacki /* L2 cache configuration registers */ 1973a1f2172SGrzegorz Bernacki static uint32_t 1983a1f2172SGrzegorz Bernacki read_l2_cache(uint32_t reg) 1993a1f2172SGrzegorz Bernacki { 2003a1f2172SGrzegorz Bernacki 2013a1f2172SGrzegorz Bernacki return (bus_space_read_4(fdtbus_bs_tag, ARMADAXP_L2_BASE, reg)); 2023a1f2172SGrzegorz Bernacki } 2033a1f2172SGrzegorz Bernacki 2043a1f2172SGrzegorz Bernacki static void 2053a1f2172SGrzegorz Bernacki write_l2_cache(uint32_t reg, uint32_t val) 2063a1f2172SGrzegorz Bernacki { 2073a1f2172SGrzegorz Bernacki 2083a1f2172SGrzegorz Bernacki bus_space_write_4(fdtbus_bs_tag, ARMADAXP_L2_BASE, reg, val); 2093a1f2172SGrzegorz Bernacki } 2103a1f2172SGrzegorz Bernacki 2113a1f2172SGrzegorz Bernacki void 2123a1f2172SGrzegorz Bernacki armadaxp_l2_idcache_inv_all(void) 2133a1f2172SGrzegorz Bernacki { 2143a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_INV_WAY, ALL_WAYS); 2153a1f2172SGrzegorz Bernacki } 2163a1f2172SGrzegorz Bernacki 2173a1f2172SGrzegorz Bernacki void 2183a1f2172SGrzegorz Bernacki armadaxp_l2_init(void) 2193a1f2172SGrzegorz Bernacki { 2203a1f2172SGrzegorz Bernacki u_int32_t reg; 2213a1f2172SGrzegorz Bernacki 2223a1f2172SGrzegorz Bernacki /* Set L2 policy */ 2233a1f2172SGrzegorz Bernacki reg = read_l2_cache(ARMADAXP_L2_AUX_CTRL); 2243a1f2172SGrzegorz Bernacki reg &= ~(L2_WBWT_MODE_MASK); 2253a1f2172SGrzegorz Bernacki reg &= ~(L2_REP_STRAT_MASK); 2263a1f2172SGrzegorz Bernacki reg |= L2_REP_STRAT_SEMIPLRU; 2273a1f2172SGrzegorz Bernacki reg |= L2_WBWT_MODE_WT; 2283a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_AUX_CTRL, reg); 2293a1f2172SGrzegorz Bernacki 2303a1f2172SGrzegorz Bernacki /* Invalidate l2 cache */ 2313a1f2172SGrzegorz Bernacki armadaxp_l2_idcache_inv_all(); 2323a1f2172SGrzegorz Bernacki 2333a1f2172SGrzegorz Bernacki /* Clear pending L2 interrupts */ 2343a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_INT_CAUSE, 0x1ff); 2353a1f2172SGrzegorz Bernacki 2363a1f2172SGrzegorz Bernacki /* Enable Cache and TLB maintenance broadcast */ 2373a1f2172SGrzegorz Bernacki __asm__ __volatile__ ("mrc p15, 1, %0, c15, c2, 0" : "=r"(reg)); 2383a1f2172SGrzegorz Bernacki reg |= (1 << 8); 2393a1f2172SGrzegorz Bernacki __asm__ __volatile__ ("mcr p15, 1, %0, c15, c2, 0" : :"r"(reg)); 2403a1f2172SGrzegorz Bernacki 2413a1f2172SGrzegorz Bernacki /* Enable l2 cache */ 2423a1f2172SGrzegorz Bernacki reg = read_l2_cache(ARMADAXP_L2_CTRL); 2433a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_CTRL, reg | L2_ENABLE); 2443a1f2172SGrzegorz Bernacki 2453a1f2172SGrzegorz Bernacki /* 2463a1f2172SGrzegorz Bernacki * For debug purposes 2473a1f2172SGrzegorz Bernacki * Configure and enable counter 2483a1f2172SGrzegorz Bernacki */ 2493a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_CNTR_CONF(0), 0xf0000 | (4 << 2)); 2503a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_CNTR_CONF(1), 0xf0000 | (2 << 2)); 2513a1f2172SGrzegorz Bernacki write_l2_cache(ARMADAXP_L2_CNTR_CTRL, 0x303); 2523a1f2172SGrzegorz Bernacki 2533a1f2172SGrzegorz Bernacki /* 2543a1f2172SGrzegorz Bernacki * Enable Cache maintenance operation propagation in coherency fabric 2553a1f2172SGrzegorz Bernacki * Change point of coherency and point of unification to DRAM. 2563a1f2172SGrzegorz Bernacki */ 2573a1f2172SGrzegorz Bernacki reg = bus_space_read_4(fdtbus_bs_tag, MV_MBUS_BRIDGE_BASE, 2583a1f2172SGrzegorz Bernacki COHER_FABRIC_CFU); 2593a1f2172SGrzegorz Bernacki reg |= (1 << 17) | (1 << 18); 2603a1f2172SGrzegorz Bernacki bus_space_write_4(fdtbus_bs_tag, MV_MBUS_BRIDGE_BASE, COHER_FABRIC_CFU, 2613a1f2172SGrzegorz Bernacki reg); 2623a1f2172SGrzegorz Bernacki } 2633a1f2172SGrzegorz Bernacki 264