Home | History | Annotate | Line # | Download | only in xscale
becc_timer.c revision 1.5.10.1
      1  1.5.10.1     yamt /*	$NetBSD: becc_timer.c,v 1.5.10.1 2005/03/19 08:32:51 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.5.10.1     yamt __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.5.10.1 2005/03/19 08:32:51 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.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.10.1     yamt 		 * 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