Home | History | Annotate | Line # | Download | only in ofw
ofwgencfg_clock.c revision 1.3.8.2 
      1 /*	$NetBSD: ofwgencfg_clock.c,v 1.3.8.2 2004/09/03 12:44:29 skrll Exp $	*/
      2 
      3 /*
      4  * Copyright 1997
      5  * Digital Equipment Corporation. All rights reserved.
      6  *
      7  * This software is furnished under license and may be used and
      8  * copied only in accordance with the following terms and conditions.
      9  * Subject to these conditions, you may download, copy, install,
     10  * use, modify and distribute this software in source and/or binary
     11  * form. No title or ownership is transferred hereby.
     12  *
     13  * 1) Any source code used, modified or distributed must reproduce
     14  *    and retain this copyright notice and list of conditions as
     15  *    they appear in the source file.
     16  *
     17  * 2) No right is granted to use any trade name, trademark, or logo of
     18  *    Digital Equipment Corporation. Neither the "Digital Equipment
     19  *    Corporation" name nor any trademark or logo of Digital Equipment
     20  *    Corporation may be used to endorse or promote products derived
     21  *    from this software without the prior written permission of
     22  *    Digital Equipment Corporation.
     23  *
     24  * 3) This software is provided "AS-IS" and any express or implied
     25  *    warranties, including but not limited to, any implied warranties
     26  *    of merchantability, fitness for a particular purpose, or
     27  *    non-infringement are disclaimed. In no event shall DIGITAL be
     28  *    liable for any damages whatsoever, and in particular, DIGITAL
     29  *    shall not be liable for special, indirect, consequential, or
     30  *    incidental damages or damages for lost profits, loss of
     31  *    revenue or loss of use, whether such damages arise in contract,
     32  *    negligence, tort, under statute, in equity, at law or otherwise,
     33  *    even if advised of the possibility of such damage.
     34  */
     35 
     36 /* Include header files */
     37 
     38 #include <sys/cdefs.h>
     39 __KERNEL_RCSID(0, "$NetBSD: ofwgencfg_clock.c,v 1.3.8.2 2004/09/03 12:44:29 skrll Exp $");
     40 
     41 #include <sys/types.h>
     42 #include <sys/param.h>
     43 #include <sys/systm.h>
     44 #include <sys/kernel.h>
     45 #include <sys/time.h>
     46 
     47 #include <machine/intr.h>
     48 #include <arm/cpufunc.h>
     49 #include <machine/cpu.h>
     50 #include <machine/ofw.h>
     51 
     52 static void *clockirq;
     53 
     54 
     55 /*
     56  * int clockhandler(struct clockframe *frame)
     57  *
     58  * Function called by timer 0 interrupts. This just calls
     59  * hardclock(). Eventually the irqhandler can call hardclock() directly
     60  * but for now we use this function so that we can debug IRQ's
     61  */
     62 
     63 static int
     64 clockhandler(struct clockframe *frame)
     65 {
     66 
     67 	hardclock(frame);
     68 	return(0);	/* Pass the interrupt on down the chain */
     69 }
     70 
     71 #if 0
     72 /*
     73  * int statclockhandler(struct clockframe *frame)
     74  *
     75  * Function called by timer 1 interrupts. This just calls
     76  * statclock(). Eventually the irqhandler can call statclock() directly
     77  * but for now we use this function so that we can debug IRQ's
     78  */
     79 
     80 int
     81 statclockhandler(frame)
     82 	struct clockframe *frame;
     83 {
     84 
     85 	statclock(frame);
     86 	return(0);	/* Pass the interrupt on down the chain */
     87 }
     88 #endif
     89 
     90 /*
     91  * void setstatclockrate(int hz)
     92  *
     93  * Set the stat clock rate. The stat clock uses timer1
     94  */
     95 
     96 void
     97 setstatclockrate(hz)
     98 	int hz;
     99 {
    100 
    101 #ifdef	OFWGENCFG
    102 	printf("Not setting statclock: OFW generic has only one clock.\n");
    103 #endif
    104 }
    105 
    106 
    107 /*
    108  * void cpu_initclocks(void)
    109  *
    110  * Initialise the clocks.
    111  * This sets up the two timers in the IOMD and installs the IRQ handlers
    112  *
    113  * NOTE: Currently only timer 0 is setup and the IRQ handler is not installed
    114  */
    115 
    116 void
    117 cpu_initclocks()
    118 {
    119 	/*
    120 	 * Load timer 0 with count down value
    121 	 * This timer generates 100Hz interrupts for the system clock
    122 	 */
    123 
    124 	printf("clock: hz=%d stathz = %d profhz = %d\n", hz, stathz, profhz);
    125 
    126         clockirq = intr_claim(IRQ_TIMER0, IPL_CLOCK, "tmr0 hard clk",
    127             (int (*)(void *))clockhandler, 0);
    128         if (clockirq == NULL)
    129                 panic("Cannot installer timer 0 IRQ handler");
    130 
    131 	/* Notify callback handler that it can start processing ticks. */
    132 	ofw_handleticks = 1;
    133 
    134 	if (stathz) {
    135 	    printf("Not installing statclock: OFW generic has only one clock.\n");
    136 	}
    137 }
    138 
    139 
    140 /*
    141  * void microtime(struct timeval *tvp)
    142  *
    143  * Fill in the specified timeval struct with the current time
    144  * accurate to the microsecond.
    145  */
    146 
    147 void
    148 microtime(tvp)
    149 	struct timeval *tvp;
    150 {
    151 	int s;
    152 	static struct timeval oldtv;
    153 
    154 	s = splhigh();
    155 
    156 	/* Fill in the timeval struct */
    157 
    158 	*tvp = time;
    159 
    160 	/* Make sure the micro seconds don't overflow. */
    161 
    162 	while (tvp->tv_usec >= 1000000) {
    163 		tvp->tv_usec -= 1000000;
    164 		++tvp->tv_sec;
    165 	}
    166 
    167 	/* Make sure the time has advanced. */
    168 
    169 	if (tvp->tv_sec == oldtv.tv_sec &&
    170 	    tvp->tv_usec <= oldtv.tv_usec) {
    171 		tvp->tv_usec = oldtv.tv_usec + 1;
    172 		if (tvp->tv_usec >= 1000000) {
    173 			tvp->tv_usec -= 1000000;
    174 			++tvp->tv_sec;
    175 		}
    176 	}
    177 
    178 
    179 	oldtv = *tvp;
    180 	(void)splx(s);
    181 }
    182 
    183 /*
    184  * Estimated loop for n microseconds
    185  */
    186 
    187 /* Need to re-write this to use the timers */
    188 
    189 /* One day soon I will actually do this */
    190 
    191 int delaycount = 50;
    192 
    193 void
    194 delay(n)
    195 	u_int n;
    196 {
    197 	u_int i;
    198 
    199 	if (n == 0) return;
    200 	while (n-- > 0) {
    201 		if (cputype == CPU_ID_SA110)	/* XXX - Seriously gross hack */
    202 			for (i = delaycount; --i;);
    203 		else
    204 			for (i = 8; --i;);
    205 	}
    206 }
    207