1/*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright 2003-2011 Netlogic Microsystems (Netlogic). All rights 5 * reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions are 9 * met: 10 * 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in 15 * the documentation and/or other materials provided with the 16 * distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY Netlogic Microsystems ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 21 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE 22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 28 * THE POSSIBILITY OF SUCH DAMAGE. 29 * 30 * NETLOGIC_BSD */ 31 32#include <sys/cdefs.h> 33__FBSDID("$FreeBSD$"); 34#include <sys/param.h> 35#include <sys/types.h> 36#include <sys/systm.h> 37 38#include <mips/nlm/hal/mips-extns.h> 39#include <mips/nlm/hal/haldefs.h> 40#include <mips/nlm/hal/iomap.h> 41#include <mips/nlm/hal/sys.h> 42#include <mips/nlm/xlp.h> 43 44uint32_t 45xlp_get_cpu_frequency(int node, int core) 46{ 47 uint64_t sysbase = nlm_get_sys_regbase(node); 48 unsigned int pll_divf, pll_divr, dfs_div, ext_div; 49 unsigned int rstval, dfsval; 50 51 rstval = nlm_read_sys_reg(sysbase, SYS_POWER_ON_RESET_CFG); 52 dfsval = nlm_read_sys_reg(sysbase, SYS_CORE_DFS_DIV_VALUE); 53 pll_divf = ((rstval >> 10) & 0x7f) + 1; 54 pll_divr = ((rstval >> 8) & 0x3) + 1; 55 if (!nlm_is_xlp8xx_ax()) 56 ext_div = ((rstval >> 30) & 0x3) + 1; 57 else 58 ext_div = 1; 59 dfs_div = ((dfsval >> (core << 2)) & 0xf) + 1; 60 61 return ((800000000ULL * pll_divf)/(3 * pll_divr * ext_div * dfs_div)); 62} 63 64static u_int 65nlm_get_device_frequency(uint64_t sysbase, int devtype) 66{ 67 uint32_t pllctrl, dfsdiv, spf, spr, div_val; 68 int extra_div; 69 70 pllctrl = nlm_read_sys_reg(sysbase, SYS_PLL_CTRL); 71 if (devtype <= 7) 72 div_val = nlm_read_sys_reg(sysbase, SYS_DFS_DIV_VALUE0); 73 else { 74 devtype -= 8; 75 div_val = nlm_read_sys_reg(sysbase, SYS_DFS_DIV_VALUE1); 76 } 77 dfsdiv = ((div_val >> (devtype << 2)) & 0xf) + 1; 78 spf = (pllctrl >> 3 & 0x7f) + 1; 79 spr = (pllctrl >> 1 & 0x03) + 1; 80 if (devtype == DFS_DEVICE_NAE && !nlm_is_xlp8xx_ax()) 81 extra_div = 2; 82 else 83 extra_div = 1; 84 85 return ((400 * spf) / (3 * extra_div * spr * dfsdiv)); 86} 87 88int 89nlm_set_device_frequency(int node, int devtype, int frequency) 90{ 91 uint64_t sysbase; 92 u_int cur_freq; 93 int dec_div; 94 95 sysbase = nlm_get_sys_regbase(node); 96 cur_freq = nlm_get_device_frequency(sysbase, devtype); 97 if (cur_freq < (frequency - 5)) 98 dec_div = 1; 99 else 100 dec_div = 0; 101 102 for(;;) { 103 if ((cur_freq >= (frequency - 5)) && (cur_freq <= frequency)) 104 break; 105 if (dec_div) 106 nlm_write_sys_reg(sysbase, SYS_DFS_DIV_DEC_CTRL, 107 (1 << devtype)); 108 else 109 nlm_write_sys_reg(sysbase, SYS_DFS_DIV_INC_CTRL, 110 (1 << devtype)); 111 cur_freq = nlm_get_device_frequency(sysbase, devtype); 112 } 113 return (nlm_get_device_frequency(sysbase, devtype)); 114} 115