Home | History | Annotate | Line # | Download | only in ep93xx
epclk.c revision 1.7
      1  1.7  hamajima /*	$NetBSD: epclk.c,v 1.7 2005/11/12 05:33:23 hamajima Exp $	*/
      2  1.1      joff 
      3  1.1      joff /*
      4  1.1      joff  * Copyright (c) 2004 Jesse Off
      5  1.1      joff  * All rights reserved.
      6  1.1      joff  *
      7  1.1      joff  * Redistribution and use in source and binary forms, with or without
      8  1.1      joff  * modification, are permitted provided that the following conditions
      9  1.1      joff  * are met:
     10  1.1      joff  * 1. Redistributions of source code must retain the above copyright
     11  1.1      joff  *    notice, this list of conditions and the following disclaimer.
     12  1.1      joff  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1      joff  *    notice, this list of conditions and the following disclaimer in the
     14  1.1      joff  *    documentation and/or other materials provided with the distribution.
     15  1.1      joff  * 3. All advertising materials mentioning features or use of this software
     16  1.1      joff  *    must display the following acknowledgement:
     17  1.1      joff  *	This product includes software developed by the NetBSD
     18  1.1      joff  *	Foundation, Inc. and its contributors.
     19  1.1      joff  * 4. Neither the name of The NetBSD Foundation nor the names of its
     20  1.1      joff  *    contributors may be used to endorse or promote products derived
     21  1.1      joff  *    from this software without specific prior written permission.
     22  1.1      joff  *
     23  1.1      joff  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     24  1.1      joff  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     25  1.1      joff  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     26  1.1      joff  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     27  1.1      joff  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     28  1.1      joff  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     29  1.1      joff  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     30  1.1      joff  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     31  1.1      joff  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     32  1.1      joff  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     33  1.1      joff  * POSSIBILITY OF SUCH DAMAGE.
     34  1.1      joff  */
     35  1.1      joff 
     36  1.1      joff /*
     37  1.1      joff  * Driver for the ep93xx clock tick.
     38  1.1      joff  *
     39  1.1      joff  * We use the 64Hz RTC interrupt as its the only thing that allows for timekeeping
     40  1.1      joff  * of a second (crystal error only).  There are two general purpose timers
     41  1.1      joff  * on the ep93xx, but they run at a frequency that makes a perfect integer
     42  1.1      joff  * number of ticks per second impossible.  Note that there was an errata with
     43  1.1      joff  * the ep93xx processor and many early boards (including the Cirrus eval board) have
     44  1.1      joff  * a broken crystal oscillator input that may make this 64Hz unreliable.  However,
     45  1.1      joff  * not all boards are susceptible, the Technologic Systems TS-7200 is a notable
     46  1.1      joff  * exception that is immune to this errata.   --joff
     47  1.1      joff  */
     48  1.1      joff 
     49  1.1      joff #include <sys/cdefs.h>
     50  1.7  hamajima __KERNEL_RCSID(0, "$NetBSD: epclk.c,v 1.7 2005/11/12 05:33:23 hamajima Exp $");
     51  1.1      joff 
     52  1.1      joff #include <sys/types.h>
     53  1.1      joff #include <sys/param.h>
     54  1.1      joff #include <sys/systm.h>
     55  1.1      joff #include <sys/kernel.h>
     56  1.1      joff #include <sys/time.h>
     57  1.1      joff #include <sys/device.h>
     58  1.1      joff 
     59  1.1      joff #include <machine/bus.h>
     60  1.1      joff #include <machine/intr.h>
     61  1.1      joff 
     62  1.1      joff #include <arm/cpufunc.h>
     63  1.1      joff 
     64  1.1      joff #include <arm/ep93xx/epsocvar.h>
     65  1.1      joff #include <arm/ep93xx/epclkreg.h>
     66  1.7  hamajima #include <arm/ep93xx/ep93xxreg.h>
     67  1.1      joff #include <arm/ep93xx/ep93xxvar.h>
     68  1.2      joff #include <dev/clock_subr.h>
     69  1.1      joff 
     70  1.7  hamajima #include "opt_hz.h"
     71  1.7  hamajima 
     72  1.1      joff static int	epclk_match(struct device *, struct cfdata *, void *);
     73  1.1      joff static void	epclk_attach(struct device *, struct device *, void *);
     74  1.1      joff 
     75  1.1      joff void		rtcinit(void);
     76  1.1      joff 
     77  1.1      joff /* callback functions for intr_functions */
     78  1.1      joff static int      epclk_intr(void* arg);
     79  1.1      joff 
     80  1.1      joff struct epclk_softc {
     81  1.1      joff 	struct device		sc_dev;
     82  1.1      joff 	bus_addr_t		sc_baseaddr;
     83  1.1      joff 	bus_space_tag_t		sc_iot;
     84  1.1      joff 	bus_space_handle_t	sc_ioh;
     85  1.7  hamajima #if defined(HZ) && (HZ == 64)
     86  1.1      joff 	bus_space_handle_t	sc_teoi_ioh;
     87  1.7  hamajima #endif
     88  1.1      joff 	int			sc_intr;
     89  1.1      joff };
     90  1.1      joff 
     91  1.1      joff static struct epclk_softc *epclk_sc = NULL;
     92  1.1      joff static u_int32_t tmark;
     93  1.1      joff 
     94  1.1      joff 
     95  1.1      joff /* This is a quick ARM way to multiply by 983040/1000000 */
     96  1.1      joff #define US_TO_TIMER4VAL(x) { \
     97  1.1      joff 	u_int32_t hi, lo, scalar = 4222124650UL; \
     98  1.1      joff 	asm volatile ( \
     99  1.1      joff 		"umull %0, %1, %2, %3;" \
    100  1.1      joff 		: "=&r"(lo), "=&r"(hi) \
    101  1.1      joff 		: "r"((x)), "r"(scalar) \
    102  1.1      joff 	); \
    103  1.1      joff 	(x) = hi; \
    104  1.1      joff }
    105  1.1      joff 
    106  1.1      joff /* This is a quick ARM way to multiply by 1000000/983040 */
    107  1.1      joff #define TIMER4VAL_TO_US(x) { \
    108  1.1      joff 	u_int32_t hi, lo, scalar = 2184533333UL; \
    109  1.1      joff 	asm volatile ( \
    110  1.1      joff 		"umull %0, %1, %2, %3;" \
    111  1.1      joff 		"mov %1, %1, lsl #1;" \
    112  1.1      joff 		"mov %0, %0, lsr #31;" \
    113  1.1      joff 		"orr %1, %1, %0;" \
    114  1.1      joff 		: "=&r"(lo), "=&r"(hi) \
    115  1.1      joff 		: "r"((x)), "r"(scalar) \
    116  1.1      joff 	); \
    117  1.1      joff 	(x) = hi; \
    118  1.1      joff }
    119  1.1      joff 
    120  1.1      joff 
    121  1.1      joff CFATTACH_DECL(epclk, sizeof(struct epclk_softc),
    122  1.1      joff     epclk_match, epclk_attach, NULL, NULL);
    123  1.1      joff 
    124  1.1      joff #define TIMER4VAL()	(*(volatile u_int32_t *)(EP93XX_APB_VBASE + \
    125  1.1      joff 	EP93XX_APB_TIMERS + EP93XX_TIMERS_Timer4ValueLow))
    126  1.1      joff 
    127  1.1      joff static int
    128  1.1      joff epclk_match(struct device *parent, struct cfdata *match, void *aux)
    129  1.1      joff {
    130  1.1      joff 
    131  1.1      joff 	return 2;
    132  1.1      joff }
    133  1.1      joff 
    134  1.1      joff static void
    135  1.1      joff epclk_attach(struct device *parent, struct device *self, void *aux)
    136  1.1      joff {
    137  1.1      joff 	struct epclk_softc		*sc;
    138  1.1      joff 	struct epsoc_attach_args	*sa;
    139  1.1      joff 
    140  1.1      joff 	printf("\n");
    141  1.1      joff 
    142  1.1      joff 	sc = (struct epclk_softc*) self;
    143  1.1      joff 	sa = aux;
    144  1.1      joff 	sc->sc_iot = sa->sa_iot;
    145  1.1      joff 	sc->sc_baseaddr = sa->sa_addr;
    146  1.1      joff 	sc->sc_intr = sa->sa_intr;
    147  1.1      joff 
    148  1.1      joff 	if (epclk_sc == NULL)
    149  1.1      joff 		epclk_sc = sc;
    150  1.1      joff 
    151  1.1      joff 	if (bus_space_map(sa->sa_iot, sa->sa_addr, sa->sa_size,
    152  1.1      joff 		0, &sc->sc_ioh))
    153  1.1      joff 		panic("%s: Cannot map registers", self->dv_xname);
    154  1.7  hamajima #if defined(HZ) && (HZ == 64)
    155  1.1      joff 	if (bus_space_map(sa->sa_iot, EP93XX_APB_HWBASE + EP93XX_APB_SYSCON +
    156  1.1      joff 		EP93XX_SYSCON_TEOI, 4, 0, &sc->sc_teoi_ioh))
    157  1.1      joff 		panic("%s: Cannot map registers", self->dv_xname);
    158  1.7  hamajima #endif
    159  1.1      joff 
    160  1.1      joff 	/* clear and start the debug timer (Timer4) */
    161  1.1      joff 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, EP93XX_TIMERS_Timer4Enable, 0);
    162  1.1      joff 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, EP93XX_TIMERS_Timer4Enable, 0x100);
    163  1.1      joff }
    164  1.1      joff 
    165  1.1      joff /*
    166  1.1      joff  * epclk_intr:
    167  1.1      joff  *
    168  1.1      joff  *	Handle the hardclock interrupt.
    169  1.1      joff  */
    170  1.1      joff static int
    171  1.1      joff epclk_intr(void *arg)
    172  1.1      joff {
    173  1.1      joff 	struct epclk_softc*	sc;
    174  1.1      joff 
    175  1.1      joff 	tmark = TIMER4VAL();
    176  1.1      joff 	sc = epclk_sc;
    177  1.1      joff 
    178  1.7  hamajima #if defined(HZ) && (HZ == 64)
    179  1.1      joff 	bus_space_write_4(sc->sc_iot, sc->sc_teoi_ioh, 0, 1);
    180  1.7  hamajima #else
    181  1.7  hamajima 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, EP93XX_TIMERS_Timer1Clear, 1);
    182  1.7  hamajima #endif
    183  1.1      joff 	hardclock((struct clockframe*) arg);
    184  1.1      joff 	return (1);
    185  1.1      joff }
    186  1.1      joff 
    187  1.1      joff /*
    188  1.1      joff  * setstatclockrate:
    189  1.1      joff  *
    190  1.1      joff  *	Set the rate of the statistics clock.
    191  1.1      joff  *
    192  1.1      joff  *	We assume that hz is either stathz or profhz, and that neither
    193  1.1      joff  *	will change after being set by cpu_initclocks().  We could
    194  1.1      joff  *	recalculate the intervals here, but that would be a pain.
    195  1.1      joff  */
    196  1.1      joff void
    197  1.6        he setstatclockrate(int newhz)
    198  1.1      joff {
    199  1.1      joff 
    200  1.1      joff 	/* use hardclock */
    201  1.1      joff }
    202  1.1      joff 
    203  1.1      joff /*
    204  1.1      joff  * cpu_initclocks:
    205  1.1      joff  *
    206  1.1      joff  *	Initialize the clock and get them going.
    207  1.1      joff  */
    208  1.1      joff void
    209  1.1      joff cpu_initclocks(void)
    210  1.1      joff {
    211  1.1      joff 	struct epclk_softc*	sc;
    212  1.1      joff 
    213  1.1      joff 	sc = epclk_sc;
    214  1.1      joff 	stathz = profhz = 0;
    215  1.1      joff 
    216  1.7  hamajima #if defined(HZ) && (HZ == 64)
    217  1.1      joff 	if (hz != 64) panic("HZ must be 64!");
    218  1.1      joff 
    219  1.1      joff 	/* clear 64Hz interrupt status */
    220  1.1      joff 	bus_space_write_4(sc->sc_iot, sc->sc_teoi_ioh, 0, 1);
    221  1.7  hamajima #else
    222  1.7  hamajima #define	CLOCK_SOURCE_RATE	14745600UL
    223  1.7  hamajima #define	CLOCK_TICK_DIV		29
    224  1.7  hamajima #define	CLOCK_TICK_RATE \
    225  1.7  hamajima 	(((CLOCK_SOURCE_RATE+(CLOCK_TICK_DIV*hz-1))/(CLOCK_TICK_DIV*hz))*hz)
    226  1.7  hamajima #define	LATCH	((CLOCK_TICK_RATE + hz/2) / hz)
    227  1.7  hamajima 	/* setup and start the 16bit timer (Timer1) */
    228  1.7  hamajima 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    229  1.7  hamajima 			  EP93XX_TIMERS_Timer1Control,
    230  1.7  hamajima 			  (TimerControl_MODE)|(TimerControl_CLKSEL));
    231  1.7  hamajima 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    232  1.7  hamajima 			  EP93XX_TIMERS_Timer1Load, LATCH-1);
    233  1.7  hamajima 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    234  1.7  hamajima 			  EP93XX_TIMERS_Timer1Control,
    235  1.7  hamajima 			  (TimerControl_ENABLE)|(TimerControl_MODE)|(TimerControl_CLKSEL));
    236  1.7  hamajima #endif
    237  1.1      joff 
    238  1.1      joff 	ep93xx_intr_establish(sc->sc_intr, IPL_CLOCK, epclk_intr, NULL);
    239  1.1      joff }
    240  1.1      joff 
    241  1.1      joff /*
    242  1.1      joff  * microtime:
    243  1.1      joff  *
    244  1.1      joff  *	Fill in the specified timeval struct with the current time
    245  1.1      joff  *	accurate to the microsecond.
    246  1.1      joff  */
    247  1.1      joff void
    248  1.1      joff microtime(register struct timeval *tvp)
    249  1.1      joff {
    250  1.1      joff 	u_int			oldirqstate;
    251  1.1      joff 	u_int			tmarknow, delta;
    252  1.1      joff 	static struct timeval	lasttv;
    253  1.1      joff 
    254  1.1      joff #ifdef DEBUG
    255  1.1      joff 	if (epclk_sc == NULL) {
    256  1.1      joff 		printf("microtime: called before initialize epclk\n");
    257  1.1      joff 		tvp->tv_sec = 0;
    258  1.1      joff 		tvp->tv_usec = 0;
    259  1.1      joff 		return;
    260  1.1      joff 	}
    261  1.1      joff #endif
    262  1.1      joff 
    263  1.1      joff 	oldirqstate = disable_interrupts(I32_bit);
    264  1.1      joff 	tmarknow = TIMER4VAL();
    265  1.1      joff 
    266  1.1      joff         /* Fill in the timeval struct. */
    267  1.1      joff 	*tvp = time;
    268  1.1      joff 	if (__predict_false(tmarknow < tmark)) { /* overflow */
    269  1.1      joff 		delta = tmarknow + (UINT_MAX - tmark);
    270  1.1      joff 	} else {
    271  1.1      joff 		delta = tmarknow - tmark;
    272  1.1      joff 	}
    273  1.1      joff 
    274  1.1      joff 	TIMER4VAL_TO_US(delta);
    275  1.1      joff 
    276  1.1      joff 	tvp->tv_usec += delta;
    277  1.1      joff 
    278  1.1      joff         /* Make sure microseconds doesn't overflow. */
    279  1.1      joff 	while (__predict_false(tvp->tv_usec >= 1000000)) {
    280  1.1      joff 		tvp->tv_usec -= 1000000;
    281  1.1      joff 		tvp->tv_sec++;
    282  1.1      joff 	}
    283  1.1      joff 
    284  1.1      joff         /* Make sure the time has advanced. */
    285  1.1      joff 	if (__predict_false(tvp->tv_sec == lasttv.tv_sec &&
    286  1.1      joff 	    tvp->tv_usec <= lasttv.tv_usec)) {
    287  1.1      joff 		tvp->tv_usec = lasttv.tv_usec + 1;
    288  1.1      joff 		if (tvp->tv_usec >= 1000000) {
    289  1.1      joff 			tvp->tv_usec -= 1000000;
    290  1.1      joff 			tvp->tv_sec++;
    291  1.1      joff 		}
    292  1.1      joff 	}
    293  1.1      joff 
    294  1.1      joff 	lasttv = *tvp;
    295  1.1      joff 
    296  1.1      joff 	restore_interrupts(oldirqstate);
    297  1.1      joff }
    298  1.1      joff 
    299  1.1      joff /*
    300  1.1      joff  * delay:
    301  1.1      joff  *
    302  1.1      joff  *	Delay for at least N microseconds.
    303  1.1      joff  */
    304  1.1      joff void
    305  1.1      joff delay(unsigned int len)
    306  1.1      joff {
    307  1.1      joff 	u_int32_t	start, end, ticks;
    308  1.1      joff 
    309  1.1      joff #ifdef DEBUG
    310  1.1      joff 	if (epclk_sc == NULL) {
    311  1.1      joff 		printf("delay: called before start epclk\n");
    312  1.1      joff 		return;
    313  1.1      joff 	}
    314  1.1      joff #endif
    315  1.1      joff 
    316  1.1      joff 	ticks = start = TIMER4VAL();
    317  1.1      joff 	US_TO_TIMER4VAL(len);
    318  1.1      joff 	end = start + len;
    319  1.1      joff 	while (start <= ticks && ticks > end) {
    320  1.1      joff 		/* wait for Timer4ValueLow wraparound */
    321  1.1      joff 		ticks = TIMER4VAL();
    322  1.1      joff 	}
    323  1.1      joff 	while (ticks <= end) {
    324  1.1      joff 		ticks = TIMER4VAL();
    325  1.1      joff 	}
    326  1.1      joff }
    327  1.1      joff 
    328  1.2      joff todr_chip_handle_t todr_handle;
    329  1.2      joff 
    330  1.2      joff /*
    331  1.2      joff  * todr_attach:
    332  1.2      joff  *
    333  1.2      joff  *	Set the specified time-of-day register as the system real-time clock.
    334  1.2      joff  */
    335  1.1      joff void
    336  1.2      joff todr_attach(todr_chip_handle_t todr)
    337  1.1      joff {
    338  1.2      joff 
    339  1.2      joff 	if (todr_handle)
    340  1.2      joff 		panic("todr_attach: rtc already configured");
    341  1.2      joff 	todr_handle = todr;
    342  1.1      joff }
    343  1.1      joff 
    344  1.2      joff /*
    345  1.2      joff  * inittodr:
    346  1.2      joff  *
    347  1.2      joff  *	Initialize time from the time-of-day register.
    348  1.2      joff  */
    349  1.2      joff #define	MINYEAR		2003	/* minimum plausible year */
    350  1.1      joff void
    351  1.1      joff inittodr(time_t base)
    352  1.1      joff {
    353  1.2      joff 	time_t deltat;
    354  1.2      joff 	int badbase;
    355  1.2      joff 
    356  1.2      joff 	if (base < (MINYEAR - 1970) * SECYR) {
    357  1.3      joff 		printf("WARNING: preposterous time in file system\n");
    358  1.2      joff 		/* read the system clock anyway */
    359  1.2      joff 		base = (MINYEAR - 1970) * SECYR;
    360  1.2      joff 		badbase = 1;
    361  1.2      joff 	} else
    362  1.2      joff 		badbase = 0;
    363  1.2      joff 
    364  1.2      joff 	if (todr_handle == NULL ||
    365  1.5        he 	    todr_gettime(todr_handle, &time) != 0 ||
    366  1.2      joff 	    time.tv_sec == 0) {
    367  1.2      joff 		/*
    368  1.2      joff 		 * Believe the time in the file system for lack of
    369  1.2      joff 		 * anything better, resetting the TODR.
    370  1.2      joff 		 */
    371  1.2      joff 		time.tv_sec = base;
    372  1.2      joff 		time.tv_usec = 0;
    373  1.2      joff 		if (todr_handle != NULL && !badbase) {
    374  1.2      joff 			printf("WARNING: preposterous clock chip time\n");
    375  1.2      joff 			resettodr();
    376  1.2      joff 		}
    377  1.2      joff 		goto bad;
    378  1.2      joff 	}
    379  1.2      joff 
    380  1.2      joff 	if (!badbase) {
    381  1.2      joff 		/*
    382  1.4    simonb 		 * See if we gained/lost two or more days; if
    383  1.2      joff 		 * so, assume something is amiss.
    384  1.2      joff 		 */
    385  1.2      joff 		deltat = time.tv_sec - base;
    386  1.2      joff 		if (deltat < 0)
    387  1.2      joff 			deltat = -deltat;
    388  1.2      joff 		if (deltat < 2 * SECDAY)
    389  1.2      joff 			return;		/* all is well */
    390  1.2      joff 		printf("WARNING: clock %s %ld days\n",
    391  1.2      joff 		    time.tv_sec < base ? "lost" : "gained",
    392  1.2      joff 		    (long)deltat / SECDAY);
    393  1.2      joff 	}
    394  1.2      joff  bad:
    395  1.2      joff 	printf("WARNING: CHECK AND RESET THE DATE!\n");
    396  1.2      joff }
    397  1.2      joff 
    398  1.2      joff /*
    399  1.2      joff  * resettodr:
    400  1.2      joff  *
    401  1.2      joff  *	Reset the time-of-day register with the current time.
    402  1.2      joff  */
    403  1.2      joff void
    404  1.2      joff resettodr(void)
    405  1.2      joff {
    406  1.2      joff 
    407  1.2      joff 	if (time.tv_sec == 0)
    408  1.2      joff 		return;
    409  1.1      joff 
    410  1.2      joff 	if (todr_handle != NULL &&
    411  1.5        he 	    todr_settime(todr_handle, &time) != 0)
    412  1.2      joff 		printf("resettodr: failed to set time\n");
    413  1.1      joff }
    414