Home | History | Annotate | Line # | Download | only in xscale
becc_timer.c revision 1.5.8.1
      1  1.5.8.1     kent /*	$NetBSD: becc_timer.c,v 1.5.8.1 2005/04/29 11:28:03 kent 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.5.8.1     kent __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.5.8.1 2005/04/29 11:28:03 kent 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.1  thorpej setstatclockrate(int 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.4  thorpej todr_chip_handle_t todr_handle;
    270      1.4  thorpej 
    271      1.4  thorpej /*
    272      1.4  thorpej  * todr_attach:
    273      1.4  thorpej  *
    274      1.4  thorpej  *	Set the specified time-of-day register as the system real-time clock.
    275      1.4  thorpej  */
    276      1.4  thorpej void
    277      1.4  thorpej todr_attach(todr_chip_handle_t todr)
    278      1.4  thorpej {
    279      1.4  thorpej 
    280      1.4  thorpej 	if (todr_handle)
    281      1.4  thorpej 		panic("todr_attach: rtc already configured");
    282      1.5  thorpej 	todr_handle = todr;
    283      1.4  thorpej }
    284      1.4  thorpej 
    285      1.1  thorpej /*
    286      1.1  thorpej  * inittodr:
    287      1.1  thorpej  *
    288      1.1  thorpej  *	Initialize time from the time-of-day register.
    289      1.1  thorpej  */
    290      1.4  thorpej #define	MINYEAR		2003	/* minimum plausible year */
    291      1.1  thorpej void
    292      1.1  thorpej inittodr(time_t base)
    293      1.1  thorpej {
    294      1.4  thorpej 	time_t deltat;
    295      1.4  thorpej 	int badbase;
    296      1.4  thorpej 
    297      1.4  thorpej 	if (base < (MINYEAR - 1970) * SECYR) {
    298      1.4  thorpej 		printf("WARNING: preposterous time in file system");
    299      1.4  thorpej 		/* read the system clock anyway */
    300      1.4  thorpej 		base = (MINYEAR - 1970) * SECYR;
    301      1.4  thorpej 		badbase = 1;
    302      1.4  thorpej 	} else
    303      1.4  thorpej 		badbase = 0;
    304      1.4  thorpej 
    305      1.4  thorpej 	if (todr_handle == NULL ||
    306      1.4  thorpej 	    todr_gettime(todr_handle, (struct timeval *)&time) != 0 ||
    307      1.4  thorpej 	    time.tv_sec == 0) {
    308      1.4  thorpej 		/*
    309      1.4  thorpej 		 * Believe the time in the file system for lack of
    310      1.4  thorpej 		 * anything better, resetting the TODR.
    311      1.4  thorpej 		 */
    312      1.4  thorpej 		time.tv_sec = base;
    313      1.4  thorpej 		time.tv_usec = 0;
    314      1.4  thorpej 		if (todr_handle != NULL && !badbase) {
    315      1.4  thorpej 			printf("WARNING: preposterous clock chip time\n");
    316      1.4  thorpej 			resettodr();
    317      1.4  thorpej 		}
    318      1.4  thorpej 		goto bad;
    319      1.4  thorpej 	}
    320      1.1  thorpej 
    321      1.4  thorpej 	if (!badbase) {
    322      1.4  thorpej 		/*
    323  1.5.8.1     kent 		 * See if we gained/lost two or more days; if
    324      1.4  thorpej 		 * so, assume something is amiss.
    325      1.4  thorpej 		 */
    326      1.4  thorpej 		deltat = time.tv_sec - base;
    327      1.4  thorpej 		if (deltat < 0)
    328      1.4  thorpej 			deltat = -deltat;
    329      1.4  thorpej 		if (deltat < 2 * SECDAY)
    330      1.4  thorpej 			return;		/* all is well */
    331      1.4  thorpej 		printf("WARNING: clock %s %ld days\n",
    332      1.4  thorpej 		    time.tv_sec < base ? "lost" : "gained",
    333      1.4  thorpej 		    (long)deltat / SECDAY);
    334      1.4  thorpej 	}
    335      1.4  thorpej  bad:
    336      1.4  thorpej 	printf("WARNING: CHECK AND RESET THE DATE!\n");
    337      1.1  thorpej }
    338      1.1  thorpej 
    339      1.1  thorpej /*
    340      1.1  thorpej  * resettodr:
    341      1.1  thorpej  *
    342      1.1  thorpej  *	Reset the time-of-day register with the current time.
    343      1.1  thorpej  */
    344      1.1  thorpej void
    345      1.1  thorpej resettodr(void)
    346      1.1  thorpej {
    347      1.4  thorpej 
    348      1.4  thorpej 	if (time.tv_sec == 0)
    349      1.4  thorpej 		return;
    350      1.4  thorpej 
    351      1.4  thorpej 	if (todr_handle != NULL &&
    352      1.4  thorpej 	    todr_settime(todr_handle, (struct timeval *)&time) != 0)
    353      1.4  thorpej 		printf("resettodr: failed to set time\n");
    354      1.1  thorpej }
    355      1.1  thorpej 
    356      1.1  thorpej /*
    357      1.1  thorpej  * clockhandler:
    358      1.1  thorpej  *
    359      1.1  thorpej  *	Handle the hardclock interrupt.
    360      1.1  thorpej  */
    361      1.1  thorpej int
    362      1.1  thorpej clockhandler(void *arg)
    363      1.1  thorpej {
    364      1.1  thorpej 	struct clockframe *frame = arg;
    365      1.1  thorpej 
    366      1.1  thorpej 	/* ACK the interrupt. */
    367      1.1  thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM | TSCRx_TIF);
    368      1.1  thorpej 
    369      1.1  thorpej 	hardclock(frame);
    370      1.1  thorpej 
    371      1.1  thorpej 	if (becc_hardclock_hook != NULL)
    372      1.1  thorpej 		(*becc_hardclock_hook)();
    373      1.1  thorpej 
    374      1.1  thorpej 	return (1);
    375      1.1  thorpej }
    376