160 lines
4.2 KiB
C
160 lines
4.2 KiB
C
/* $NetBSD: ofwgencfg_clock.c,v 1.10 2009/03/18 10:22:24 cegger Exp $ */
|
|
|
|
/*
|
|
* Copyright 1997
|
|
* Digital Equipment Corporation. All rights reserved.
|
|
*
|
|
* This software is furnished under license and may be used and
|
|
* copied only in accordance with the following terms and conditions.
|
|
* Subject to these conditions, you may download, copy, install,
|
|
* use, modify and distribute this software in source and/or binary
|
|
* form. No title or ownership is transferred hereby.
|
|
*
|
|
* 1) Any source code used, modified or distributed must reproduce
|
|
* and retain this copyright notice and list of conditions as
|
|
* they appear in the source file.
|
|
*
|
|
* 2) No right is granted to use any trade name, trademark, or logo of
|
|
* Digital Equipment Corporation. Neither the "Digital Equipment
|
|
* Corporation" name nor any trademark or logo of Digital Equipment
|
|
* Corporation may be used to endorse or promote products derived
|
|
* from this software without the prior written permission of
|
|
* Digital Equipment Corporation.
|
|
*
|
|
* 3) This software is provided "AS-IS" and any express or implied
|
|
* warranties, including but not limited to, any implied warranties
|
|
* of merchantability, fitness for a particular purpose, or
|
|
* non-infringement are disclaimed. In no event shall DIGITAL be
|
|
* liable for any damages whatsoever, and in particular, DIGITAL
|
|
* shall not be liable for special, indirect, consequential, or
|
|
* incidental damages or damages for lost profits, loss of
|
|
* revenue or loss of use, whether such damages arise in contract,
|
|
* negligence, tort, under statute, in equity, at law or otherwise,
|
|
* even if advised of the possibility of such damage.
|
|
*/
|
|
|
|
/* Include header files */
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: ofwgencfg_clock.c,v 1.10 2009/03/18 10:22:24 cegger Exp $");
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/time.h>
|
|
|
|
#include <machine/intr.h>
|
|
#include <machine/irqhandler.h>
|
|
#include <arm/cpufunc.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/ofw.h>
|
|
|
|
static void *clockirq;
|
|
|
|
|
|
/*
|
|
* int clockhandler(struct clockframe *frame)
|
|
*
|
|
* Function called by timer 0 interrupts. This just calls
|
|
* hardclock(). Eventually the irqhandler can call hardclock() directly
|
|
* but for now we use this function so that we can debug IRQ's
|
|
*/
|
|
|
|
static int
|
|
clockhandler(struct clockframe *frame)
|
|
{
|
|
|
|
hardclock(frame);
|
|
return(0); /* Pass the interrupt on down the chain */
|
|
}
|
|
|
|
#if 0
|
|
/*
|
|
* int statclockhandler(struct clockframe *frame)
|
|
*
|
|
* Function called by timer 1 interrupts. This just calls
|
|
* statclock(). Eventually the irqhandler can call statclock() directly
|
|
* but for now we use this function so that we can debug IRQ's
|
|
*/
|
|
|
|
int
|
|
statclockhandler(struct clockframe *frame)
|
|
{
|
|
|
|
statclock(frame);
|
|
return(0); /* Pass the interrupt on down the chain */
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* void setstatclockrate(int hz)
|
|
*
|
|
* Set the stat clock rate. The stat clock uses timer1
|
|
*/
|
|
|
|
void
|
|
setstatclockrate(int arg)
|
|
{
|
|
#ifdef OFWGENCFG
|
|
printf("Not setting statclock: OFW generic has only one clock.\n");
|
|
#endif
|
|
}
|
|
|
|
|
|
/*
|
|
* void cpu_initclocks(void)
|
|
*
|
|
* Initialise the clocks.
|
|
* This sets up the two timers in the IOMD and installs the IRQ handlers
|
|
*
|
|
* NOTE: Currently only timer 0 is setup and the IRQ handler is not installed
|
|
*/
|
|
|
|
void
|
|
cpu_initclocks(void)
|
|
{
|
|
/*
|
|
* Load timer 0 with count down value
|
|
* This timer generates 100Hz interrupts for the system clock
|
|
*/
|
|
|
|
printf("clock: hz=%d stathz = %d profhz = %d\n", hz, stathz, profhz);
|
|
|
|
clockirq = intr_claim(IRQ_TIMER0, IPL_CLOCK,
|
|
(int (*)(void *))clockhandler, 0, "clock", "hard intr");
|
|
if (clockirq == NULL)
|
|
panic("Cannot installer timer 0 IRQ handler");
|
|
|
|
/* Notify callback handler that it can start processing ticks. */
|
|
ofw_handleticks = 1;
|
|
|
|
if (stathz) {
|
|
printf("Not installing statclock: OFW generic has only one clock.\n");
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Estimated loop for n microseconds
|
|
*/
|
|
|
|
/* Need to re-write this to use the timers */
|
|
|
|
/* One day soon I will actually do this */
|
|
|
|
int delaycount = 50;
|
|
|
|
void
|
|
delay(u_int n)
|
|
{
|
|
u_int i;
|
|
|
|
if (n == 0) return;
|
|
while (n-- > 0) {
|
|
if (cputype == CPU_ID_SA110) /* XXX - Seriously gross hack */
|
|
for (i = delaycount; --i;);
|
|
else
|
|
for (i = 8; --i;);
|
|
}
|
|
}
|