Home | History | Annotate | Line # | Download | only in xscale
becc_timer.c revision 1.8.2.3
      1  1.8.2.3      yamt /*	$NetBSD: becc_timer.c,v 1.8.2.3 2008/01/21 09:35:50 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.3      yamt __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.8.2.3 2008/01/21 09:35:50 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.8.2.3      yamt #include <sys/atomic.h>
     49      1.1   thorpej #include <sys/time.h>
     50  1.8.2.3      yamt #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.8.2.3      yamt static u_int	becc_get_timecount(struct timecounter *);
     71  1.8.2.3      yamt 
     72  1.8.2.3      yamt static struct timecounter becc_timecounter = {
     73  1.8.2.3      yamt 	becc_get_timecount,	/* get_timecount */
     74  1.8.2.3      yamt 	0,			/* no poll_pps */
     75  1.8.2.3      yamt 	0xffffffff,		/* counter_mask */
     76  1.8.2.3      yamt 	COUNTS_PER_SEC,		/* frequency */
     77  1.8.2.3      yamt 	"becc",			/* name */
     78  1.8.2.3      yamt 	100,			/* quality */
     79  1.8.2.3      yamt 	NULL,			/* prev */
     80  1.8.2.3      yamt 	NULL,			/* next */
     81  1.8.2.3      yamt };
     82  1.8.2.3      yamt 
     83  1.8.2.3      yamt static volatile uint32_t becc_base;
     84  1.8.2.3      yamt 
     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.8.2.3      yamt #ifdef __HAVE_FAST_SOFTINTS
    174      1.1   thorpej 	/* register soft interrupt handler as well */
    175  1.8.2.3      yamt 	becc_intr_establish(ICU_SOFT, IPL_SOFTCLOCK, becc_softint, NULL);
    176  1.8.2.3      yamt #endif
    177      1.1   thorpej 
    178      1.1   thorpej 	restore_interrupts(oldirqstate);
    179  1.8.2.3      yamt 
    180  1.8.2.3      yamt 	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.8.2.3      yamt static u_int
    202  1.8.2.3      yamt becc_get_timecount(struct timecounter *tc)
    203      1.1   thorpej {
    204  1.8.2.3      yamt 	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.8.2.3      yamt 	counter = BECC_CSR_READ(BECC_TCVRA);
    209  1.8.2.3      yamt 	base = becc_base;
    210      1.1   thorpej 	restore_interrupts(oldirqstate);
    211  1.8.2.3      yamt 
    212  1.8.2.3      yamt 	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.8.2.3      yamt 	atomic_add_32(&becc_base, counts_per_hz);
    266  1.8.2.3      yamt 
    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