Home | History | Annotate | Line # | Download | only in ofw
ofwgencfg_clock.c revision 1.4 
      1 /*	$NetBSD: ofwgencfg_clock.c,v 1.4 2003/07/15 00:24:48 lukem 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.4 2003/07/15 00:24:48 lukem 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 int
     64 clockhandler(frame)
     65 	struct clockframe *frame;
     66 {
     67 
     68 	hardclock(frame);
     69 	return(0);	/* Pass the interrupt on down the chain */
     70 }
     71 
     72 
     73 /*
     74  * int statclockhandler(struct clockframe *frame)
     75  *
     76  * Function called by timer 1 interrupts. This just calls
     77  * statclock(). Eventually the irqhandler can call statclock() directly
     78  * but for now we use this function so that we can debug IRQ's
     79  */
     80 
     81 int
     82 statclockhandler(frame)
     83 	struct clockframe *frame;
     84 {
     85 
     86 	statclock(frame);
     87 	return(0);	/* Pass the interrupt on down the chain */
     88 }
     89 
     90 
     91 /*
     92  * void setstatclockrate(int hz)
     93  *
     94  * Set the stat clock rate. The stat clock uses timer1
     95  */
     96 
     97 void
     98 setstatclockrate(hz)
     99 	int hz;
    100 {
    101 
    102 #ifdef	OFWGENCFG
    103 	printf("Not setting statclock: OFW generic has only one clock.\n");
    104 #endif
    105 }
    106 
    107 
    108 /*
    109  * void cpu_initclocks(void)
    110  *
    111  * Initialise the clocks.
    112  * This sets up the two timers in the IOMD and installs the IRQ handlers
    113  *
    114  * NOTE: Currently only timer 0 is setup and the IRQ handler is not installed
    115  */
    116 
    117 void
    118 cpu_initclocks()
    119 {
    120 	/*
    121 	 * Load timer 0 with count down value
    122 	 * This timer generates 100Hz interrupts for the system clock
    123 	 */
    124 
    125 	printf("clock: hz=%d stathz = %d profhz = %d\n", hz, stathz, profhz);
    126 
    127         clockirq = intr_claim(IRQ_TIMER0, IPL_CLOCK, "tmr0 hard clk",
    128             clockhandler, 0);
    129         if (clockirq == NULL)
    130                 panic("Cannot installer timer 0 IRQ handler");
    131 
    132 	/* Notify callback handler that it can start processing ticks. */
    133 	ofw_handleticks = 1;
    134 
    135 	if (stathz) {
    136 	    printf("Not installing statclock: OFW generic has only one clock.\n");
    137 	}
    138 }
    139 
    140 
    141 /*
    142  * void microtime(struct timeval *tvp)
    143  *
    144  * Fill in the specified timeval struct with the current time
    145  * accurate to the microsecond.
    146  */
    147 
    148 void
    149 microtime(tvp)
    150 	struct timeval *tvp;
    151 {
    152 	int s;
    153 	static struct timeval oldtv;
    154 
    155 	s = splhigh();
    156 
    157 	/* Fill in the timeval struct */
    158 
    159 	*tvp = time;
    160 
    161 	/* Make sure the micro seconds don't overflow. */
    162 
    163 	while (tvp->tv_usec >= 1000000) {
    164 		tvp->tv_usec -= 1000000;
    165 		++tvp->tv_sec;
    166 	}
    167 
    168 	/* Make sure the time has advanced. */
    169 
    170 	if (tvp->tv_sec == oldtv.tv_sec &&
    171 	    tvp->tv_usec <= oldtv.tv_usec) {
    172 		tvp->tv_usec = oldtv.tv_usec + 1;
    173 		if (tvp->tv_usec >= 1000000) {
    174 			tvp->tv_usec -= 1000000;
    175 			++tvp->tv_sec;
    176 		}
    177 	}
    178 
    179 
    180 	oldtv = *tvp;
    181 	(void)splx(s);
    182 }
    183 
    184 /*
    185  * Estimated loop for n microseconds
    186  */
    187 
    188 /* Need to re-write this to use the timers */
    189 
    190 /* One day soon I will actually do this */
    191 
    192 int delaycount = 50;
    193 
    194 void
    195 delay(n)
    196 	u_int n;
    197 {
    198 	u_int i;
    199 
    200 	if (n == 0) return;
    201 	while (n-- > 0) {
    202 		if (cputype == CPU_ID_SA110)	/* XXX - Seriously gross hack */
    203 			for (i = delaycount; --i;);
    204 		else
    205 			for (i = 8; --i;);
    206 	}
    207 }
    208