Home | History | Annotate | Line # | Download | only in xscale
becc_timer.c revision 1.8.2.1
      1  1.8.2.1      yamt /*	$NetBSD: becc_timer.c,v 1.8.2.1 2006/12/30 20:45:37 yamt Exp $	*/
      2      1.1   thorpej 
      3      1.1   thorpej /*
      4      1.1   thorpej  * Copyright (c) 2001, 2002 Wasabi Systems, Inc.
      5      1.1   thorpej  * All rights reserved.
      6      1.1   thorpej  *
      7      1.1   thorpej  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
      8      1.1   thorpej  *
      9      1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     10      1.1   thorpej  * modification, are permitted provided that the following conditions
     11      1.1   thorpej  * are met:
     12      1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     13      1.1   thorpej  *    notice, this list of conditions and the following disclaimer.
     14      1.1   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     15      1.1   thorpej  *    notice, this list of conditions and the following disclaimer in the
     16      1.1   thorpej  *    documentation and/or other materials provided with the distribution.
     17      1.1   thorpej  * 3. All advertising materials mentioning features or use of this software
     18      1.1   thorpej  *    must display the following acknowledgement:
     19      1.1   thorpej  *	This product includes software developed for the NetBSD Project by
     20      1.1   thorpej  *	Wasabi Systems, Inc.
     21      1.1   thorpej  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
     22      1.1   thorpej  *    or promote products derived from this software without specific prior
     23      1.1   thorpej  *    written permission.
     24      1.1   thorpej  *
     25      1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
     26      1.1   thorpej  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27      1.1   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28      1.1   thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
     29      1.1   thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30      1.1   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31      1.1   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32      1.1   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33      1.1   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34      1.1   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35      1.1   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     36      1.1   thorpej  */
     37      1.1   thorpej 
     38      1.1   thorpej /*
     39      1.1   thorpej  * Timer/clock support for the ADI Engineering Big Endian Companion Chip.
     40      1.1   thorpej  */
     41      1.3     lukem 
     42      1.3     lukem #include <sys/cdefs.h>
     43  1.8.2.1      yamt __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.8.2.1 2006/12/30 20:45:37 yamt Exp $");
     44      1.1   thorpej 
     45      1.1   thorpej #include <sys/param.h>
     46      1.1   thorpej #include <sys/systm.h>
     47      1.1   thorpej #include <sys/kernel.h>
     48      1.1   thorpej #include <sys/time.h>
     49      1.1   thorpej 
     50      1.4   thorpej #include <dev/clock_subr.h>
     51      1.4   thorpej 
     52      1.1   thorpej #include <machine/bus.h>
     53      1.1   thorpej #include <arm/cpufunc.h>
     54      1.1   thorpej 
     55      1.1   thorpej #include <arm/xscale/beccreg.h>
     56      1.1   thorpej #include <arm/xscale/beccvar.h>
     57      1.1   thorpej 
     58      1.1   thorpej void	(*becc_hardclock_hook)(void);
     59      1.1   thorpej 
     60      1.1   thorpej /*
     61      1.1   thorpej  * Note, since COUNTS_PER_USEC doesn't divide evenly, we round up.
     62      1.1   thorpej  */
     63      1.1   thorpej #define	COUNTS_PER_SEC		BECC_PERIPH_CLOCK
     64      1.1   thorpej #define	COUNTS_PER_USEC		((COUNTS_PER_SEC / 1000000) + 1)
     65      1.1   thorpej 
     66      1.1   thorpej static void *clock_ih;
     67      1.1   thorpej 
     68      1.1   thorpej /*
     69      1.1   thorpej  * Since the timer interrupts when the counter underflows, we need to
     70      1.1   thorpej  * subtract 1 from counts_per_hz when loading the preload register.
     71      1.1   thorpej  */
     72      1.1   thorpej static uint32_t counts_per_hz;
     73      1.1   thorpej 
     74      1.1   thorpej int	clockhandler(void *);
     75      1.1   thorpej 
     76      1.1   thorpej /*
     77      1.1   thorpej  * becc_calibrate_delay:
     78      1.1   thorpej  *
     79      1.1   thorpej  *	Calibrate the delay loop.
     80      1.1   thorpej  */
     81      1.1   thorpej void
     82      1.1   thorpej becc_calibrate_delay(void)
     83      1.1   thorpej {
     84      1.1   thorpej 
     85      1.1   thorpej 	/*
     86      1.1   thorpej 	 * Just use hz=100 for now -- we'll adjust it, if necessary,
     87      1.1   thorpej 	 * in cpu_initclocks().
     88      1.1   thorpej 	 */
     89      1.1   thorpej 	counts_per_hz = COUNTS_PER_SEC / 100;
     90      1.1   thorpej 
     91      1.1   thorpej 	/* Stop both timers, clear interrupts. */
     92      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
     93      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRB, TSCRx_TIF);
     94      1.1   thorpej 
     95      1.1   thorpej 	/* Set the timer preload value. */
     96      1.1   thorpej 	BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
     97      1.1   thorpej 
     98      1.1   thorpej 	/* Start the timer. */
     99      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
    100      1.1   thorpej }
    101      1.1   thorpej 
    102      1.1   thorpej /*
    103      1.1   thorpej  * cpu_initclocks:
    104      1.1   thorpej  *
    105      1.1   thorpej  *	Initialize the clock and get them going.
    106      1.1   thorpej  */
    107      1.1   thorpej void
    108      1.1   thorpej cpu_initclocks(void)
    109      1.1   thorpej {
    110      1.1   thorpej 	u_int oldirqstate;
    111      1.1   thorpej 
    112      1.1   thorpej #if 0
    113      1.1   thorpej 	if (hz < 50 || COUNTS_PER_SEC % hz) {
    114      1.1   thorpej 		printf("Cannot get %d Hz clock; using 100 Hz\n", hz);
    115      1.1   thorpej 		hz = 100;
    116      1.1   thorpej 	}
    117      1.1   thorpej #endif
    118      1.1   thorpej 	tick = 1000000 / hz;	/* number of microseconds between interrupts */
    119      1.1   thorpej 	tickfix = 1000000 - (hz * tick);
    120      1.1   thorpej 	if (tickfix) {
    121      1.1   thorpej 		int ftp;
    122      1.1   thorpej 
    123      1.1   thorpej 		ftp = min(ffs(tickfix), ffs(hz));
    124      1.1   thorpej 		tickfix >>= (ftp - 1);
    125      1.1   thorpej 		tickfixinterval = hz >> (ftp - 1);
    126      1.1   thorpej 	}
    127      1.1   thorpej 
    128      1.1   thorpej 	/*
    129      1.1   thorpej 	 * We only have one timer available; stathz and profhz are
    130      1.1   thorpej 	 * always left as 0 (the upper-layer clock code deals with
    131      1.1   thorpej 	 * this situation).
    132      1.1   thorpej 	 */
    133      1.1   thorpej 	if (stathz != 0)
    134      1.1   thorpej 		printf("Cannot get %d Hz statclock\n", stathz);
    135      1.1   thorpej 	stathz = 0;
    136      1.1   thorpej 
    137      1.1   thorpej 	if (profhz != 0)
    138      1.1   thorpej 		printf("Cannot get %d Hz profclock\n", profhz);
    139      1.1   thorpej 	profhz = 0;
    140      1.1   thorpej 
    141      1.1   thorpej 	/* Report the clock frequency. */
    142      1.2    briggs 	aprint_normal("clock: hz=%d stathz=%d profhz=%d\n", hz, stathz, profhz);
    143      1.1   thorpej 
    144      1.1   thorpej 	oldirqstate = disable_interrupts(I32_bit);
    145      1.1   thorpej 
    146      1.1   thorpej 	/* Hook up the clock interrupt handler. */
    147      1.1   thorpej 	clock_ih = becc_intr_establish(ICU_TIMERA, IPL_CLOCK,
    148      1.1   thorpej 	    clockhandler, NULL);
    149      1.1   thorpej 	if (clock_ih == NULL)
    150      1.1   thorpej 		panic("cpu_initclocks: unable to register timer interrupt");
    151      1.1   thorpej 
    152      1.1   thorpej 	/* Set up the new clock parameters. */
    153      1.1   thorpej 
    154      1.1   thorpej 	/* Stop timer, clear interrupt */
    155      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
    156      1.1   thorpej 
    157      1.1   thorpej 	counts_per_hz = COUNTS_PER_SEC / hz;
    158      1.1   thorpej 
    159      1.1   thorpej 	/* Set the timer preload value. */
    160      1.1   thorpej 	BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
    161      1.1   thorpej 
    162      1.1   thorpej 	/* ...and start it in motion. */
    163      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
    164      1.1   thorpej 
    165      1.1   thorpej 	/* register soft interrupt handler as well */
    166      1.1   thorpej 	becc_intr_establish(ICU_SOFT, IPL_SOFT, becc_softint, NULL);
    167      1.1   thorpej 
    168      1.1   thorpej 	restore_interrupts(oldirqstate);
    169      1.1   thorpej }
    170      1.1   thorpej 
    171      1.1   thorpej /*
    172      1.1   thorpej  * setstatclockrate:
    173      1.1   thorpej  *
    174      1.1   thorpej  *	Set the rate of the statistics clock.
    175      1.1   thorpej  *
    176      1.1   thorpej  *	We assume that hz is either stathz or profhz, and that neither
    177      1.1   thorpej  *	will change after being set by cpu_initclocks().  We could
    178      1.1   thorpej  *	recalculate the intervals here, but that would be a pain.
    179      1.1   thorpej  */
    180      1.1   thorpej void
    181      1.7  rearnsha setstatclockrate(int new_hz)
    182      1.1   thorpej {
    183      1.1   thorpej 
    184      1.1   thorpej 	/*
    185      1.1   thorpej 	 * XXX Use TMR1?
    186      1.1   thorpej 	 */
    187      1.1   thorpej }
    188      1.1   thorpej 
    189      1.1   thorpej /*
    190      1.1   thorpej  * microtime:
    191      1.1   thorpej  *
    192      1.1   thorpej  *	Fill in the specified timeval struct with the current time
    193      1.1   thorpej  *	accurate to the microsecond.
    194      1.1   thorpej  */
    195      1.1   thorpej void
    196      1.1   thorpej microtime(struct timeval *tvp)
    197      1.1   thorpej {
    198      1.1   thorpej 	static struct timeval lasttv;
    199      1.1   thorpej 	u_int oldirqstate;
    200      1.1   thorpej 	uint32_t counts;
    201      1.1   thorpej 
    202      1.1   thorpej 	oldirqstate = disable_interrupts(I32_bit);
    203      1.1   thorpej 
    204      1.1   thorpej 	/*
    205      1.1   thorpej 	 * XXX How do we compensate for the -1 behavior of the preload value?
    206      1.1   thorpej 	 */
    207      1.1   thorpej 	counts = counts_per_hz - BECC_CSR_READ(BECC_TCVRA);
    208      1.1   thorpej 
    209      1.1   thorpej 	/* Fill in the timeval struct. */
    210      1.1   thorpej 	*tvp = time;
    211      1.1   thorpej 	tvp->tv_usec += (counts / COUNTS_PER_USEC);
    212      1.1   thorpej 
    213      1.1   thorpej 	/* Make sure microseconds doesn't overflow. */
    214      1.1   thorpej 	while (tvp->tv_usec >= 1000000) {
    215      1.1   thorpej 		tvp->tv_usec -= 1000000;
    216      1.1   thorpej 		tvp->tv_sec++;
    217      1.1   thorpej 	}
    218      1.1   thorpej 
    219      1.1   thorpej 	/* Make sure the time has advanced. */
    220      1.1   thorpej 	if (tvp->tv_sec == lasttv.tv_sec &&
    221      1.1   thorpej 	    tvp->tv_usec <= lasttv.tv_usec) {
    222      1.1   thorpej 		tvp->tv_usec = lasttv.tv_usec + 1;
    223      1.1   thorpej 		if (tvp->tv_usec >= 1000000) {
    224      1.1   thorpej 			tvp->tv_usec -= 1000000;
    225      1.1   thorpej 			tvp->tv_sec++;
    226      1.1   thorpej 		}
    227      1.1   thorpej 	}
    228      1.1   thorpej 
    229      1.1   thorpej 	lasttv = *tvp;
    230      1.1   thorpej 
    231      1.1   thorpej 	restore_interrupts(oldirqstate);
    232      1.1   thorpej }
    233      1.1   thorpej 
    234      1.1   thorpej /*
    235      1.1   thorpej  * delay:
    236      1.1   thorpej  *
    237      1.1   thorpej  *	Delay for at least N microseconds.
    238      1.1   thorpej  */
    239      1.1   thorpej void
    240      1.1   thorpej delay(u_int n)
    241      1.1   thorpej {
    242      1.1   thorpej 	uint32_t cur, last, delta, usecs;
    243      1.1   thorpej 
    244      1.1   thorpej 	/*
    245      1.1   thorpej 	 * This works by polling the timer and counting the
    246      1.1   thorpej 	 * number of microseconds that go by.
    247      1.1   thorpej 	 */
    248      1.1   thorpej 	last = BECC_CSR_READ(BECC_TCVRA);
    249      1.1   thorpej 	delta = usecs = 0;
    250      1.1   thorpej 
    251      1.1   thorpej 	while (n > usecs) {
    252      1.1   thorpej 		cur = BECC_CSR_READ(BECC_TCVRA);
    253      1.1   thorpej 
    254      1.1   thorpej 		/* Check to see if the timer has wrapped around. */
    255      1.1   thorpej 		if (last < cur)
    256      1.1   thorpej 			delta += (last + (counts_per_hz - cur));
    257      1.1   thorpej 		else
    258      1.1   thorpej 			delta += (last - cur);
    259      1.1   thorpej 
    260      1.1   thorpej 		last = cur;
    261      1.1   thorpej 
    262      1.1   thorpej 		if (delta >= COUNTS_PER_USEC) {
    263      1.1   thorpej 			usecs += delta / COUNTS_PER_USEC;
    264      1.1   thorpej 			delta %= COUNTS_PER_USEC;
    265      1.1   thorpej 		}
    266      1.1   thorpej 	}
    267      1.1   thorpej }
    268      1.1   thorpej 
    269  1.8.2.1      yamt #ifndef __HAVE_GENERIC_TODR
    270  1.8.2.1      yamt 
    271      1.4   thorpej todr_chip_handle_t todr_handle;
    272      1.4   thorpej 
    273      1.4   thorpej /*
    274      1.4   thorpej  * todr_attach:
    275      1.4   thorpej  *
    276      1.4   thorpej  *	Set the specified time-of-day register as the system real-time clock.
    277      1.4   thorpej  */
    278      1.4   thorpej void
    279      1.4   thorpej todr_attach(todr_chip_handle_t todr)
    280      1.4   thorpej {
    281      1.4   thorpej 
    282      1.4   thorpej 	if (todr_handle)
    283      1.4   thorpej 		panic("todr_attach: rtc already configured");
    284      1.5   thorpej 	todr_handle = todr;
    285      1.4   thorpej }
    286      1.4   thorpej 
    287      1.1   thorpej /*
    288      1.1   thorpej  * inittodr:
    289      1.1   thorpej  *
    290      1.1   thorpej  *	Initialize time from the time-of-day register.
    291      1.1   thorpej  */
    292      1.4   thorpej #define	MINYEAR		2003	/* minimum plausible year */
    293      1.1   thorpej void
    294      1.1   thorpej inittodr(time_t base)
    295      1.1   thorpej {
    296      1.4   thorpej 	time_t deltat;
    297      1.4   thorpej 	int badbase;
    298      1.4   thorpej 
    299      1.4   thorpej 	if (base < (MINYEAR - 1970) * SECYR) {
    300      1.4   thorpej 		printf("WARNING: preposterous time in file system");
    301      1.4   thorpej 		/* read the system clock anyway */
    302      1.4   thorpej 		base = (MINYEAR - 1970) * SECYR;
    303      1.4   thorpej 		badbase = 1;
    304      1.4   thorpej 	} else
    305      1.4   thorpej 		badbase = 0;
    306      1.4   thorpej 
    307      1.4   thorpej 	if (todr_handle == NULL ||
    308      1.8        he 	    todr_gettime(todr_handle, &time) != 0 || time.tv_sec == 0) {
    309      1.4   thorpej 		/*
    310      1.4   thorpej 		 * Believe the time in the file system for lack of
    311      1.4   thorpej 		 * anything better, resetting the TODR.
    312      1.4   thorpej 		 */
    313      1.4   thorpej 		time.tv_sec = base;
    314      1.4   thorpej 		time.tv_usec = 0;
    315      1.4   thorpej 		if (todr_handle != NULL && !badbase) {
    316      1.4   thorpej 			printf("WARNING: preposterous clock chip time\n");
    317      1.4   thorpej 			resettodr();
    318      1.4   thorpej 		}
    319      1.4   thorpej 		goto bad;
    320      1.4   thorpej 	}
    321      1.1   thorpej 
    322      1.4   thorpej 	if (!badbase) {
    323      1.4   thorpej 		/*
    324      1.6    simonb 		 * See if we gained/lost two or more days; if
    325      1.4   thorpej 		 * so, assume something is amiss.
    326      1.4   thorpej 		 */
    327      1.4   thorpej 		deltat = time.tv_sec - base;
    328      1.4   thorpej 		if (deltat < 0)
    329      1.4   thorpej 			deltat = -deltat;
    330      1.4   thorpej 		if (deltat < 2 * SECDAY)
    331      1.4   thorpej 			return;		/* all is well */
    332      1.4   thorpej 		printf("WARNING: clock %s %ld days\n",
    333      1.4   thorpej 		    time.tv_sec < base ? "lost" : "gained",
    334      1.4   thorpej 		    (long)deltat / SECDAY);
    335      1.4   thorpej 	}
    336      1.4   thorpej  bad:
    337      1.4   thorpej 	printf("WARNING: CHECK AND RESET THE DATE!\n");
    338      1.1   thorpej }
    339      1.1   thorpej 
    340      1.1   thorpej /*
    341      1.1   thorpej  * resettodr:
    342      1.1   thorpej  *
    343      1.1   thorpej  *	Reset the time-of-day register with the current time.
    344      1.1   thorpej  */
    345      1.1   thorpej void
    346      1.1   thorpej resettodr(void)
    347      1.1   thorpej {
    348      1.4   thorpej 
    349      1.4   thorpej 	if (time.tv_sec == 0)
    350      1.4   thorpej 		return;
    351      1.4   thorpej 
    352      1.8        he 	if (todr_handle != NULL &&
    353      1.8        he 	    todr_settime(todr_handle, &time) != 0)
    354      1.4   thorpej 		printf("resettodr: failed to set time\n");
    355      1.1   thorpej }
    356  1.8.2.1      yamt #endif	/* __HAVE_GENERIC_TODR */
    357      1.1   thorpej 
    358      1.1   thorpej /*
    359      1.1   thorpej  * clockhandler:
    360      1.1   thorpej  *
    361      1.1   thorpej  *	Handle the hardclock interrupt.
    362      1.1   thorpej  */
    363      1.1   thorpej int
    364      1.1   thorpej clockhandler(void *arg)
    365      1.1   thorpej {
    366      1.1   thorpej 	struct clockframe *frame = arg;
    367      1.1   thorpej 
    368      1.1   thorpej 	/* ACK the interrupt. */
    369      1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM | TSCRx_TIF);
    370      1.1   thorpej 
    371      1.1   thorpej 	hardclock(frame);
    372      1.1   thorpej 
    373      1.1   thorpej 	if (becc_hardclock_hook != NULL)
    374      1.1   thorpej 		(*becc_hardclock_hook)();
    375      1.1   thorpej 
    376      1.1   thorpej 	return (1);
    377      1.1   thorpej }
    378