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 3916694521SOleksandr Tymoshenko #include <arm/mv/mvreg.h> 4016694521SOleksandr Tymoshenko #include <arm/mv/mvvar.h> 4116694521SOleksandr Tymoshenko 4216694521SOleksandr Tymoshenko #include <dev/fdt/fdt_common.h> 4316694521SOleksandr Tymoshenko #include <dev/ofw/openfirm.h> 4416694521SOleksandr Tymoshenko 4516694521SOleksandr Tymoshenko #include <machine/fdt.h> 4616694521SOleksandr Tymoshenko 47d65cdf4bSGrzegorz Bernacki #define CPU_FREQ_FIELD(sar) (((0x01 & (sar >> 52)) << 3) | \ 48d65cdf4bSGrzegorz Bernacki (0x07 & (sar >> 21))) 49d65cdf4bSGrzegorz Bernacki #define FAB_FREQ_FIELD(sar) (((0x01 & (sar >> 51)) << 4) | \ 50d65cdf4bSGrzegorz Bernacki (0x0F & (sar >> 24))) 51d65cdf4bSGrzegorz Bernacki 52d65cdf4bSGrzegorz Bernacki static uint32_t count_l2clk(void); 53d65cdf4bSGrzegorz Bernacki 54d65cdf4bSGrzegorz Bernacki /* XXX Make gpio driver optional and remove it */ 5516694521SOleksandr Tymoshenko struct resource_spec mv_gpio_res[] = { 5616694521SOleksandr Tymoshenko { SYS_RES_MEMORY, 0, RF_ACTIVE }, 5716694521SOleksandr Tymoshenko { SYS_RES_IRQ, 0, RF_ACTIVE }, 5816694521SOleksandr Tymoshenko { -1, 0 } 5916694521SOleksandr Tymoshenko }; 6016694521SOleksandr Tymoshenko 61d65cdf4bSGrzegorz Bernacki struct vco_freq_ratio { 62d65cdf4bSGrzegorz Bernacki uint8_t vco_cpu; /* VCO to CLK0(CPU) clock ratio */ 63d65cdf4bSGrzegorz Bernacki uint8_t vco_l2c; /* VCO to NB(L2 cache) clock ratio */ 64d65cdf4bSGrzegorz Bernacki uint8_t vco_hcl; /* VCO to HCLK(DDR controller) clock ratio */ 65d65cdf4bSGrzegorz Bernacki uint8_t vco_ddr; /* VCO to DR(DDR memory) clock ratio */ 66d65cdf4bSGrzegorz Bernacki }; 67d65cdf4bSGrzegorz Bernacki 68d65cdf4bSGrzegorz Bernacki static struct vco_freq_ratio freq_conf_table[] = { 69d65cdf4bSGrzegorz Bernacki /*00*/ { 1, 1, 4, 2 }, 70d65cdf4bSGrzegorz Bernacki /*01*/ { 1, 2, 2, 2 }, 71d65cdf4bSGrzegorz Bernacki /*02*/ { 2, 2, 6, 3 }, 72d65cdf4bSGrzegorz Bernacki /*03*/ { 2, 2, 3, 3 }, 73d65cdf4bSGrzegorz Bernacki /*04*/ { 1, 2, 3, 3 }, 74d65cdf4bSGrzegorz Bernacki /*05*/ { 1, 2, 4, 2 }, 75d65cdf4bSGrzegorz Bernacki /*06*/ { 1, 1, 2, 2 }, 76d65cdf4bSGrzegorz Bernacki /*07*/ { 2, 3, 6, 6 }, 77d65cdf4bSGrzegorz Bernacki /*08*/ { 2, 3, 5, 5 }, 78d65cdf4bSGrzegorz Bernacki /*09*/ { 1, 2, 6, 3 }, 79d65cdf4bSGrzegorz Bernacki /*10*/ { 2, 4, 10, 5 }, 80d65cdf4bSGrzegorz Bernacki /*11*/ { 1, 3, 6, 6 }, 81d65cdf4bSGrzegorz Bernacki /*12*/ { 1, 2, 5, 5 }, 82d65cdf4bSGrzegorz Bernacki /*13*/ { 1, 3, 6, 3 }, 83d65cdf4bSGrzegorz Bernacki /*14*/ { 1, 2, 5, 5 }, 84d65cdf4bSGrzegorz Bernacki /*15*/ { 2, 2, 5, 5 }, 85d65cdf4bSGrzegorz Bernacki /*16*/ { 1, 1, 3, 3 }, 86d65cdf4bSGrzegorz Bernacki /*17*/ { 2, 5, 10, 10 }, 87d65cdf4bSGrzegorz Bernacki /*18*/ { 1, 3, 8, 4 }, 88d65cdf4bSGrzegorz Bernacki /*19*/ { 1, 1, 2, 1 }, 89d65cdf4bSGrzegorz Bernacki /*20*/ { 2, 3, 6, 3 }, 90d65cdf4bSGrzegorz Bernacki /*21*/ { 1, 2, 8, 4 }, 91d65cdf4bSGrzegorz Bernacki /*22*/ { 2, 5, 10, 5 } 92d65cdf4bSGrzegorz Bernacki }; 93d65cdf4bSGrzegorz Bernacki 94d65cdf4bSGrzegorz Bernacki static uint16_t cpu_clock_table[] = { 95d65cdf4bSGrzegorz Bernacki 1000, 1066, 1200, 1333, 1500, 1666, 1800, 2000, 600, 667, 800, 1600, 96d65cdf4bSGrzegorz Bernacki 2133, 2200, 2400 }; 97d65cdf4bSGrzegorz Bernacki 9816694521SOleksandr Tymoshenko uint32_t 9916694521SOleksandr Tymoshenko get_tclk(void) 10016694521SOleksandr Tymoshenko { 101d65cdf4bSGrzegorz Bernacki uint32_t cputype; 10216694521SOleksandr Tymoshenko 103d65cdf4bSGrzegorz Bernacki cputype = cpufunc_id(); 104d65cdf4bSGrzegorz Bernacki cputype &= CPU_ID_CPU_MASK; 105d65cdf4bSGrzegorz Bernacki 106d65cdf4bSGrzegorz Bernacki if (cputype == CPU_ID_MV88SV584X_V7) 107d65cdf4bSGrzegorz Bernacki return (TCLK_250MHZ); 108d65cdf4bSGrzegorz Bernacki else 10916694521SOleksandr Tymoshenko return (TCLK_200MHZ); 11016694521SOleksandr Tymoshenko } 11116694521SOleksandr Tymoshenko 112d65cdf4bSGrzegorz Bernacki static uint32_t 113d65cdf4bSGrzegorz Bernacki count_l2clk(void) 114d65cdf4bSGrzegorz Bernacki { 115d65cdf4bSGrzegorz Bernacki uint64_t sar_reg; 116d65cdf4bSGrzegorz Bernacki uint32_t freq_vco, freq_l2clk; 117d65cdf4bSGrzegorz Bernacki uint8_t sar_cpu_freq, sar_fab_freq, array_size; 118d65cdf4bSGrzegorz Bernacki 119d65cdf4bSGrzegorz Bernacki /* Get value of the SAR register and process it */ 120d65cdf4bSGrzegorz Bernacki sar_reg = get_sar_value(); 121d65cdf4bSGrzegorz Bernacki sar_cpu_freq = CPU_FREQ_FIELD(sar_reg); 122d65cdf4bSGrzegorz Bernacki sar_fab_freq = FAB_FREQ_FIELD(sar_reg); 123d65cdf4bSGrzegorz Bernacki 124d65cdf4bSGrzegorz Bernacki /* Check if CPU frequency field has correct value */ 125d65cdf4bSGrzegorz Bernacki array_size = sizeof(cpu_clock_table) / sizeof(cpu_clock_table[0]); 126d65cdf4bSGrzegorz Bernacki if (sar_cpu_freq >= array_size) 127d65cdf4bSGrzegorz Bernacki panic("Reserved value in cpu frequency configuration field: " 128d65cdf4bSGrzegorz Bernacki "%d", sar_cpu_freq); 129d65cdf4bSGrzegorz Bernacki 130d65cdf4bSGrzegorz Bernacki /* Check if fabric frequency field has correct value */ 131d65cdf4bSGrzegorz Bernacki array_size = sizeof(freq_conf_table) / sizeof(freq_conf_table[0]); 132d65cdf4bSGrzegorz Bernacki if (sar_fab_freq >= array_size) 133d65cdf4bSGrzegorz Bernacki panic("Reserved value in fabric frequency configuration field: " 134d65cdf4bSGrzegorz Bernacki "%d", sar_fab_freq); 135d65cdf4bSGrzegorz Bernacki 136d65cdf4bSGrzegorz Bernacki /* Get CPU clock frequency */ 137d65cdf4bSGrzegorz Bernacki freq_vco = cpu_clock_table[sar_cpu_freq] * 138d65cdf4bSGrzegorz Bernacki freq_conf_table[sar_fab_freq].vco_cpu; 139d65cdf4bSGrzegorz Bernacki 140d65cdf4bSGrzegorz Bernacki /* Get L2CLK clock frequency */ 141d65cdf4bSGrzegorz Bernacki freq_l2clk = freq_vco / freq_conf_table[sar_fab_freq].vco_l2c; 142d65cdf4bSGrzegorz Bernacki 143d65cdf4bSGrzegorz Bernacki /* Round L2CLK value to integer MHz */ 144d65cdf4bSGrzegorz Bernacki if (((freq_vco % freq_conf_table[sar_fab_freq].vco_l2c) * 10 / 145d65cdf4bSGrzegorz Bernacki freq_conf_table[sar_fab_freq].vco_l2c) >= 5) 146d65cdf4bSGrzegorz Bernacki freq_l2clk++; 147d65cdf4bSGrzegorz Bernacki 148d65cdf4bSGrzegorz Bernacki return (freq_l2clk * 1000000); 149d65cdf4bSGrzegorz Bernacki } 150d65cdf4bSGrzegorz Bernacki 15116694521SOleksandr Tymoshenko uint32_t 15216694521SOleksandr Tymoshenko get_l2clk(void) 15316694521SOleksandr Tymoshenko { 154d65cdf4bSGrzegorz Bernacki static uint32_t l2clk_freq = 0; 15516694521SOleksandr Tymoshenko 156d65cdf4bSGrzegorz Bernacki /* If get_l2clk is called first time get L2CLK value from register */ 157d65cdf4bSGrzegorz Bernacki if (l2clk_freq == 0) 158d65cdf4bSGrzegorz Bernacki l2clk_freq = count_l2clk(); 159d65cdf4bSGrzegorz Bernacki 160d65cdf4bSGrzegorz Bernacki return (l2clk_freq); 16116694521SOleksandr Tymoshenko } 16216694521SOleksandr Tymoshenko 16316694521SOleksandr Tymoshenko int 16416694521SOleksandr Tymoshenko fdt_pci_devmap(phandle_t node, struct pmap_devmap *devmap, vm_offset_t io_va, 16516694521SOleksandr Tymoshenko vm_offset_t mem_va) 16616694521SOleksandr Tymoshenko { 16716694521SOleksandr Tymoshenko 16816694521SOleksandr Tymoshenko return (0); 16916694521SOleksandr Tymoshenko } 17016694521SOleksandr Tymoshenko 171