|  | /* | 
|  | * BRIEF MODULE DESCRIPTION | 
|  | *	Simple Au1xx0 clocks routines. | 
|  | * | 
|  | * Copyright 2001, 2008 MontaVista Software Inc. | 
|  | * Author: MontaVista Software, Inc. <source@mvista.com> | 
|  | * | 
|  | *  This program is free software; you can redistribute	 it and/or modify it | 
|  | *  under  the terms of	 the GNU General  Public License as published by the | 
|  | *  Free Software Foundation;  either version 2 of the	License, or (at your | 
|  | *  option) any later version. | 
|  | * | 
|  | *  THIS  SOFTWARE  IS PROVIDED	  ``AS	IS'' AND   ANY	EXPRESS OR IMPLIED | 
|  | *  WARRANTIES,	  INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF | 
|  | *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN | 
|  | *  NO	EVENT  SHALL   THE AUTHOR  BE	 LIABLE FOR ANY	  DIRECT, INDIRECT, | 
|  | *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | 
|  | *  NOT LIMITED	  TO, PROCUREMENT OF  SUBSTITUTE GOODS	OR SERVICES; LOSS OF | 
|  | *  USE, DATA,	OR PROFITS; OR	BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | 
|  | *  ANY THEORY OF LIABILITY, WHETHER IN	 CONTRACT, STRICT LIABILITY, OR TORT | 
|  | *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | 
|  | *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
|  | * | 
|  | *  You should have received a copy of the  GNU General Public License along | 
|  | *  with this program; if not, write  to the Free Software Foundation, Inc., | 
|  | *  675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | */ | 
|  |  | 
|  | #include <linux/module.h> | 
|  | #include <linux/spinlock.h> | 
|  | #include <asm/time.h> | 
|  | #include <asm/mach-au1x00/au1000.h> | 
|  |  | 
|  | /* | 
|  | * I haven't found anyone that doesn't use a 12 MHz source clock, | 
|  | * but just in case..... | 
|  | */ | 
|  | #define AU1000_SRC_CLK	12000000 | 
|  |  | 
|  | static unsigned int au1x00_clock; /*  Hz */ | 
|  | static unsigned long uart_baud_base; | 
|  |  | 
|  | /* | 
|  | * Set the au1000_clock | 
|  | */ | 
|  | void set_au1x00_speed(unsigned int new_freq) | 
|  | { | 
|  | au1x00_clock = new_freq; | 
|  | } | 
|  |  | 
|  | unsigned int get_au1x00_speed(void) | 
|  | { | 
|  | return au1x00_clock; | 
|  | } | 
|  | EXPORT_SYMBOL(get_au1x00_speed); | 
|  |  | 
|  | /* | 
|  | * The UART baud base is not known at compile time ... if | 
|  | * we want to be able to use the same code on different | 
|  | * speed CPUs. | 
|  | */ | 
|  | unsigned long get_au1x00_uart_baud_base(void) | 
|  | { | 
|  | return uart_baud_base; | 
|  | } | 
|  |  | 
|  | void set_au1x00_uart_baud_base(unsigned long new_baud_base) | 
|  | { | 
|  | uart_baud_base = new_baud_base; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * We read the real processor speed from the PLL.  This is important | 
|  | * because it is more accurate than computing it from the 32 KHz | 
|  | * counter, if it exists.  If we don't have an accurate processor | 
|  | * speed, all of the peripherals that derive their clocks based on | 
|  | * this advertised speed will introduce error and sometimes not work | 
|  | * properly.  This function is futher convoluted to still allow configurations | 
|  | * to do that in case they have really, really old silicon with a | 
|  | * write-only PLL register.			-- Dan | 
|  | */ | 
|  | unsigned long au1xxx_calc_clock(void) | 
|  | { | 
|  | unsigned long cpu_speed; | 
|  |  | 
|  | /* | 
|  | * On early Au1000, sys_cpupll was write-only. Since these | 
|  | * silicon versions of Au1000 are not sold by AMD, we don't bend | 
|  | * over backwards trying to determine the frequency. | 
|  | */ | 
|  | if (au1xxx_cpu_has_pll_wo()) | 
|  | cpu_speed = 396000000; | 
|  | else | 
|  | cpu_speed = (au_readl(SYS_CPUPLL) & 0x0000003f) * AU1000_SRC_CLK; | 
|  |  | 
|  | /* On Alchemy CPU:counter ratio is 1:1 */ | 
|  | mips_hpt_frequency = cpu_speed; | 
|  | /* Equation: Baudrate = CPU / (SD * 2 * CLKDIV * 16) */ | 
|  | set_au1x00_uart_baud_base(cpu_speed / (2 * ((int)(au_readl(SYS_POWERCTRL) | 
|  | & 0x03) + 2) * 16)); | 
|  |  | 
|  | set_au1x00_speed(cpu_speed); | 
|  |  | 
|  | return cpu_speed; | 
|  | } |