time.c revision 1c0c13eb935c95fd2ca0b0aca6dd4860487fb242
11c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno/*
21c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org>
31c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *
41c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  This program is free software; you can redistribute  it and/or modify it
51c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  under  the terms of  the GNU General  Public License as published by the
61c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  Free Software Foundation;  either version 2 of the  License, or (at your
71c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  option) any later version.
81c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *
91c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
101c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
111c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
121c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
131c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
141c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
151c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
161c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
171c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
181c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
191c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *
201c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  You should have received a copy of the  GNU General Public License along
211c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  with this program; if not, write  to the Free Software Foundation, Inc.,
221c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno *  675 Mass Ave, Cambridge, MA 02139, USA.
231c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno */
241c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
251c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
261c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <linux/init.h>
271c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <linux/ssb/ssb.h>
281c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <asm/time.h>
291c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <bcm47xx.h>
301c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
311c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarnovoid __init
321c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarnobcm47xx_time_init(void)
331c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno{
341c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	unsigned long hz;
351c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
361c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	/*
371c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	 * Use deterministic values for initial counter interrupt
381c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	 * so that calibrate delay avoids encountering a counter wrap.
391c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	 */
401c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	write_c0_count(0);
411c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	write_c0_compare(0xffff);
421c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
431c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	hz = ssb_cpu_clock(&ssb_bcm47xx.mipscore) / 2;
441c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	if (!hz)
451c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno		hz = 100000000;
461c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
471c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	/* Set MIPS counter frequency for fixed_rate_gettimeoffset() */
481c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	mips_hpt_frequency = hz;
491c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno}
501c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno
511c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarnovoid __init
521c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarnoplat_timer_setup(struct irqaction *irq)
531c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno{
541c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	/* Enable the timer interrupt */
551c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno	setup_irq(7, irq);
561c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno}
57