Home | History | Annotate | Line # | Download | only in xscale
becc_timer.c revision 1.11.32.1
      1  1.11.32.1       mjf /*	$NetBSD: becc_timer.c,v 1.11.32.1 2008/02/18 21:04:24 mjf 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.11.32.1       mjf __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.11.32.1 2008/02/18 21:04:24 mjf 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.11.32.1       mjf #include <sys/atomic.h>
     49        1.1   thorpej #include <sys/time.h>
     50  1.11.32.1       mjf #include <sys/timetc.h>
     51        1.1   thorpej 
     52        1.4   thorpej #include <dev/clock_subr.h>
     53        1.4   thorpej 
     54        1.1   thorpej #include <machine/bus.h>
     55        1.1   thorpej #include <arm/cpufunc.h>
     56        1.1   thorpej 
     57        1.1   thorpej #include <arm/xscale/beccreg.h>
     58        1.1   thorpej #include <arm/xscale/beccvar.h>
     59        1.1   thorpej 
     60        1.1   thorpej void	(*becc_hardclock_hook)(void);
     61        1.1   thorpej 
     62        1.1   thorpej /*
     63        1.1   thorpej  * Note, since COUNTS_PER_USEC doesn't divide evenly, we round up.
     64        1.1   thorpej  */
     65        1.1   thorpej #define	COUNTS_PER_SEC		BECC_PERIPH_CLOCK
     66        1.1   thorpej #define	COUNTS_PER_USEC		((COUNTS_PER_SEC / 1000000) + 1)
     67        1.1   thorpej 
     68        1.1   thorpej static void *clock_ih;
     69        1.1   thorpej 
     70  1.11.32.1       mjf static u_int	becc_get_timecount(struct timecounter *);
     71  1.11.32.1       mjf 
     72  1.11.32.1       mjf static struct timecounter becc_timecounter = {
     73  1.11.32.1       mjf 	becc_get_timecount,	/* get_timecount */
     74  1.11.32.1       mjf 	0,			/* no poll_pps */
     75  1.11.32.1       mjf 	0xffffffff,		/* counter_mask */
     76  1.11.32.1       mjf 	COUNTS_PER_SEC,		/* frequency */
     77  1.11.32.1       mjf 	"becc",			/* name */
     78  1.11.32.1       mjf 	100,			/* quality */
     79  1.11.32.1       mjf 	NULL,			/* prev */
     80  1.11.32.1       mjf 	NULL,			/* next */
     81  1.11.32.1       mjf };
     82  1.11.32.1       mjf 
     83  1.11.32.1       mjf static volatile uint32_t becc_base;
     84  1.11.32.1       mjf 
     85        1.1   thorpej /*
     86        1.1   thorpej  * Since the timer interrupts when the counter underflows, we need to
     87        1.1   thorpej  * subtract 1 from counts_per_hz when loading the preload register.
     88        1.1   thorpej  */
     89        1.1   thorpej static uint32_t counts_per_hz;
     90        1.1   thorpej 
     91        1.1   thorpej int	clockhandler(void *);
     92        1.1   thorpej 
     93        1.1   thorpej /*
     94        1.1   thorpej  * becc_calibrate_delay:
     95        1.1   thorpej  *
     96        1.1   thorpej  *	Calibrate the delay loop.
     97        1.1   thorpej  */
     98        1.1   thorpej void
     99        1.1   thorpej becc_calibrate_delay(void)
    100        1.1   thorpej {
    101        1.1   thorpej 
    102        1.1   thorpej 	/*
    103        1.1   thorpej 	 * Just use hz=100 for now -- we'll adjust it, if necessary,
    104        1.1   thorpej 	 * in cpu_initclocks().
    105        1.1   thorpej 	 */
    106        1.1   thorpej 	counts_per_hz = COUNTS_PER_SEC / 100;
    107        1.1   thorpej 
    108        1.1   thorpej 	/* Stop both timers, clear interrupts. */
    109        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
    110        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRB, TSCRx_TIF);
    111        1.1   thorpej 
    112        1.1   thorpej 	/* Set the timer preload value. */
    113        1.1   thorpej 	BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
    114        1.1   thorpej 
    115        1.1   thorpej 	/* Start the timer. */
    116        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
    117        1.1   thorpej }
    118        1.1   thorpej 
    119        1.1   thorpej /*
    120        1.1   thorpej  * cpu_initclocks:
    121        1.1   thorpej  *
    122        1.1   thorpej  *	Initialize the clock and get them going.
    123        1.1   thorpej  */
    124        1.1   thorpej void
    125        1.1   thorpej cpu_initclocks(void)
    126        1.1   thorpej {
    127        1.1   thorpej 	u_int oldirqstate;
    128        1.1   thorpej 
    129        1.1   thorpej #if 0
    130        1.1   thorpej 	if (hz < 50 || COUNTS_PER_SEC % hz) {
    131        1.1   thorpej 		printf("Cannot get %d Hz clock; using 100 Hz\n", hz);
    132        1.1   thorpej 		hz = 100;
    133        1.1   thorpej 	}
    134        1.1   thorpej #endif
    135        1.1   thorpej 
    136        1.1   thorpej 	/*
    137        1.1   thorpej 	 * We only have one timer available; stathz and profhz are
    138        1.1   thorpej 	 * always left as 0 (the upper-layer clock code deals with
    139        1.1   thorpej 	 * this situation).
    140        1.1   thorpej 	 */
    141        1.1   thorpej 	if (stathz != 0)
    142        1.1   thorpej 		printf("Cannot get %d Hz statclock\n", stathz);
    143        1.1   thorpej 	stathz = 0;
    144        1.1   thorpej 
    145        1.1   thorpej 	if (profhz != 0)
    146        1.1   thorpej 		printf("Cannot get %d Hz profclock\n", profhz);
    147        1.1   thorpej 	profhz = 0;
    148        1.1   thorpej 
    149        1.1   thorpej 	/* Report the clock frequency. */
    150        1.2    briggs 	aprint_normal("clock: hz=%d stathz=%d profhz=%d\n", hz, stathz, profhz);
    151        1.1   thorpej 
    152        1.1   thorpej 	oldirqstate = disable_interrupts(I32_bit);
    153        1.1   thorpej 
    154        1.1   thorpej 	/* Hook up the clock interrupt handler. */
    155        1.1   thorpej 	clock_ih = becc_intr_establish(ICU_TIMERA, IPL_CLOCK,
    156        1.1   thorpej 	    clockhandler, NULL);
    157        1.1   thorpej 	if (clock_ih == NULL)
    158        1.1   thorpej 		panic("cpu_initclocks: unable to register timer interrupt");
    159        1.1   thorpej 
    160        1.1   thorpej 	/* Set up the new clock parameters. */
    161        1.1   thorpej 
    162        1.1   thorpej 	/* Stop timer, clear interrupt */
    163        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
    164        1.1   thorpej 
    165        1.1   thorpej 	counts_per_hz = COUNTS_PER_SEC / hz;
    166        1.1   thorpej 
    167        1.1   thorpej 	/* Set the timer preload value. */
    168        1.1   thorpej 	BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
    169        1.1   thorpej 
    170        1.1   thorpej 	/* ...and start it in motion. */
    171        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
    172        1.1   thorpej 
    173  1.11.32.1       mjf #ifdef __HAVE_FAST_SOFTINTS
    174        1.1   thorpej 	/* register soft interrupt handler as well */
    175  1.11.32.1       mjf 	becc_intr_establish(ICU_SOFT, IPL_SOFTCLOCK, becc_softint, NULL);
    176  1.11.32.1       mjf #endif
    177        1.1   thorpej 
    178        1.1   thorpej 	restore_interrupts(oldirqstate);
    179  1.11.32.1       mjf 
    180  1.11.32.1       mjf 	tc_init(&becc_timecounter);
    181        1.1   thorpej }
    182        1.1   thorpej 
    183        1.1   thorpej /*
    184        1.1   thorpej  * setstatclockrate:
    185        1.1   thorpej  *
    186        1.1   thorpej  *	Set the rate of the statistics clock.
    187        1.1   thorpej  *
    188        1.1   thorpej  *	We assume that hz is either stathz or profhz, and that neither
    189        1.1   thorpej  *	will change after being set by cpu_initclocks().  We could
    190        1.1   thorpej  *	recalculate the intervals here, but that would be a pain.
    191        1.1   thorpej  */
    192        1.1   thorpej void
    193        1.7  rearnsha setstatclockrate(int new_hz)
    194        1.1   thorpej {
    195        1.1   thorpej 
    196        1.1   thorpej 	/*
    197        1.1   thorpej 	 * XXX Use TMR1?
    198        1.1   thorpej 	 */
    199        1.1   thorpej }
    200        1.1   thorpej 
    201  1.11.32.1       mjf static u_int
    202  1.11.32.1       mjf becc_get_timecount(struct timecounter *tc)
    203        1.1   thorpej {
    204  1.11.32.1       mjf 	uint32_t counter, base;
    205        1.1   thorpej 	u_int oldirqstate;
    206        1.1   thorpej 
    207        1.1   thorpej 	oldirqstate = disable_interrupts(I32_bit);
    208  1.11.32.1       mjf 	counter = BECC_CSR_READ(BECC_TCVRA);
    209  1.11.32.1       mjf 	base = becc_base;
    210        1.1   thorpej 	restore_interrupts(oldirqstate);
    211  1.11.32.1       mjf 
    212  1.11.32.1       mjf 	return base - counter;
    213        1.1   thorpej }
    214        1.1   thorpej 
    215        1.1   thorpej /*
    216        1.1   thorpej  * delay:
    217        1.1   thorpej  *
    218        1.1   thorpej  *	Delay for at least N microseconds.
    219        1.1   thorpej  */
    220        1.1   thorpej void
    221        1.1   thorpej delay(u_int n)
    222        1.1   thorpej {
    223        1.1   thorpej 	uint32_t cur, last, delta, usecs;
    224        1.1   thorpej 
    225        1.1   thorpej 	/*
    226        1.1   thorpej 	 * This works by polling the timer and counting the
    227        1.1   thorpej 	 * number of microseconds that go by.
    228        1.1   thorpej 	 */
    229        1.1   thorpej 	last = BECC_CSR_READ(BECC_TCVRA);
    230        1.1   thorpej 	delta = usecs = 0;
    231        1.1   thorpej 
    232        1.1   thorpej 	while (n > usecs) {
    233        1.1   thorpej 		cur = BECC_CSR_READ(BECC_TCVRA);
    234        1.1   thorpej 
    235        1.1   thorpej 		/* Check to see if the timer has wrapped around. */
    236        1.1   thorpej 		if (last < cur)
    237        1.1   thorpej 			delta += (last + (counts_per_hz - cur));
    238        1.1   thorpej 		else
    239        1.1   thorpej 			delta += (last - cur);
    240        1.1   thorpej 
    241        1.1   thorpej 		last = cur;
    242        1.1   thorpej 
    243        1.1   thorpej 		if (delta >= COUNTS_PER_USEC) {
    244        1.1   thorpej 			usecs += delta / COUNTS_PER_USEC;
    245        1.1   thorpej 			delta %= COUNTS_PER_USEC;
    246        1.1   thorpej 		}
    247        1.1   thorpej 	}
    248        1.1   thorpej }
    249        1.1   thorpej 
    250        1.1   thorpej /*
    251        1.1   thorpej  * clockhandler:
    252        1.1   thorpej  *
    253        1.1   thorpej  *	Handle the hardclock interrupt.
    254        1.1   thorpej  */
    255        1.1   thorpej int
    256        1.1   thorpej clockhandler(void *arg)
    257        1.1   thorpej {
    258        1.1   thorpej 	struct clockframe *frame = arg;
    259        1.1   thorpej 
    260        1.1   thorpej 	/* ACK the interrupt. */
    261        1.1   thorpej 	BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM | TSCRx_TIF);
    262        1.1   thorpej 
    263        1.1   thorpej 	hardclock(frame);
    264        1.1   thorpej 
    265  1.11.32.1       mjf 	atomic_add_32(&becc_base, counts_per_hz);
    266  1.11.32.1       mjf 
    267        1.1   thorpej 	if (becc_hardclock_hook != NULL)
    268        1.1   thorpej 		(*becc_hardclock_hook)();
    269        1.1   thorpej 
    270        1.1   thorpej 	return (1);
    271        1.1   thorpej }
    272