diff options
Diffstat (limited to 'sys/powerpc/aim/clock.c')
| -rw-r--r-- | sys/powerpc/aim/clock.c | 235 |
1 files changed, 235 insertions, 0 deletions
diff --git a/sys/powerpc/aim/clock.c b/sys/powerpc/aim/clock.c new file mode 100644 index 0000000..c2a9944 --- /dev/null +++ b/sys/powerpc/aim/clock.c @@ -0,0 +1,235 @@ +/* + * Copyright (C) 1995, 1996 Wolfgang Solfrank. + * Copyright (C) 1995, 1996 TooLs GmbH. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by TooLs GmbH. + * 4. The name of TooLs GmbH may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``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 TOOLS GMBH 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. + * + * $NetBSD: clock.c,v 1.9 2000/01/19 02:52:19 msaitoh Exp $ */ + */ + +#ifndef lint +static const char rcsid[] = + "$FreeBSD$"; +#endif /* not lint */ + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/bus.h> +#include <sys/kernel.h> +#include <sys/timetc.h> +#include <sys/interrupt.h> + +#include <vm/vm.h> + +#include <dev/ofw/openfirm.h> + +#include <machine/clock.h> +#include <machine/cpu.h> + +#if 0 /* XXX */ +#include "adb.h" +#else +#define NADB 0 +#endif + +/* + * Initially we assume a processor with a bus frequency of 12.5 MHz. + */ +static u_long ns_per_tick = 80; +static long ticks_per_intr; +static volatile u_long lasttb; + +#define SECDAY 86400 +#define DIFF19041970 2082844800 + +#if NADB > 0 +extern int adb_read_date_time __P((int *)); +extern int adb_set_date_time __P((int)); +#endif + +static int clockinitted = 0; + +void +inittodr(time_t base) +{ + time_t deltat; + u_int rtc_time; + struct timespec ts; + + /* + * If we can't read from RTC, use the fs time. + */ +#if NADB > 0 + if (adb_read_date_time(&rtc_time) < 0) +#endif + { + ts.tv_sec = base; + ts.tv_nsec = 0; + tc_setclock(&ts); + return; + } + clockinitted = 1; + ts.tv_sec = rtc_time - DIFF19041970; + + deltat = ts.tv_sec - base; + if (deltat < 0) { + deltat = -deltat; + } + if (deltat < 2 * SECDAY) { + tc_setclock(&ts); + return; + } + + printf("WARNING: clock %s %d days", + ts.tv_sec < base ? "lost" : "gained", (int)(deltat / SECDAY)); + + printf(" -- CHECK AND RESET THE DATE!\n"); +} + +/* + * Similar to the above + */ +void +resettodr() +{ +#if NADB > 0 + u_int rtc_time; + + if (clockinitted) { + rtc_time = time.tv_sec + DIFF19041970; + adb_set_date_time(rtc_time); + } +#endif +} + +void +decr_intr(struct clockframe *frame) +{ + u_long tb; + long tick; + int nticks; + + /* + * Check whether we are initialized. + */ + if (!ticks_per_intr) + return; + + /* + * Based on the actual time delay since the last decrementer reload, + * we arrange for earlier interrupt next time. + */ + __asm ("mftb %0; mfdec %1" : "=r"(tb), "=r"(tick)); + for (nticks = 0; tick < 0; nticks++) + tick += ticks_per_intr; + __asm __volatile ("mtdec %0" :: "r"(tick)); + /* + * lasttb is used during microtime. Set it to the virtual + * start of this tick interval. + */ + lasttb = tb + tick - ticks_per_intr; + +#if 0 /* XXX */ + intrcnt[CNT_CLOCK]++; + { + int pri; + int msr; + + pri = splclock(); + if (pri & (1 << SPL_CLOCK)) { + tickspending += nticks; + } + else { + nticks += tickspending; + tickspending = 0; + + /* + * Reenable interrupts + */ + __asm __volatile ("mfmsr %0; ori %0, %0, %1; mtmsr %0" + : "=r"(msr) : "K"(PSL_EE)); + + /* + * Do standard timer interrupt stuff. + * Do softclock stuff only on the last iteration. + */ + frame->pri = pri | (1 << SIR_CLOCK); + while (--nticks > 0) + hardclock(frame); + frame->pri = pri; + hardclock(frame); + } + splx(pri); + } +#endif +} + +void +cpu_initclocks(void) +{ + + /* Do nothing */ +} + +static __inline u_quad_t +mftb(void) +{ + u_long scratch; + u_quad_t tb; + + __asm ("1: mftbu %0; mftb %0+1; mftbu %1; cmpw 0,%0,%1; bne 1b" + : "=r"(tb), "=r"(scratch)); + return tb; +} + +/* + * Wait for about n microseconds (at least!). + */ +void +delay(unsigned n) +{ + u_quad_t tb; + u_long tbh, tbl, scratch; + + tb = mftb(); + tb += (n * 1000 + ns_per_tick - 1) / ns_per_tick; + tbh = tb >> 32; + tbl = tb; + __asm ("1: mftbu %0; cmplw %0,%1; blt 1b; bgt 2f;" + "mftb %0; cmplw %0,%2; blt 1b; 2:" + :: "r"(scratch), "r"(tbh), "r"(tbl)); +} + +/* + * Nothing to do. + */ +void +setstatclockrate(int arg) +{ + + /* Do nothing */ +} |
