Home | History | Annotate | Line # | Download | only in iq80310
      1  1.24   andvar /*	$NetBSD: iq80310_timer.c,v 1.24 2024/07/20 20:36:33 andvar Exp $	*/
      2   1.1  thorpej 
      3   1.1  thorpej /*
      4   1.7  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 Intel IQ80310.
     40   1.1  thorpej  *
     41   1.1  thorpej  * The IQ80310 has a 22-bit reloadable timer implemented in the CPLD.
     42   1.1  thorpej  * We use it to provide a hardclock interrupt.  There is no RTC on
     43   1.1  thorpej  * the IQ80310.
     44   1.1  thorpej  *
     45   1.1  thorpej  * The timer uses the SPCI clock.  The timer uses the 33MHz clock by
     46   1.1  thorpej  * reading the SPCI_66EN signal and dividing the clock if necessary.
     47   1.1  thorpej  */
     48  1.12    lukem 
     49  1.12    lukem #include <sys/cdefs.h>
     50  1.24   andvar __KERNEL_RCSID(0, "$NetBSD: iq80310_timer.c,v 1.24 2024/07/20 20:36:33 andvar Exp $");
     51   1.1  thorpej 
     52   1.1  thorpej #include <sys/param.h>
     53   1.1  thorpej #include <sys/systm.h>
     54   1.1  thorpej #include <sys/kernel.h>
     55  1.21    joerg #include <sys/atomic.h>
     56   1.1  thorpej #include <sys/time.h>
     57  1.21    joerg #include <sys/timetc.h>
     58   1.1  thorpej 
     59  1.13  thorpej #include <dev/clock_subr.h>
     60  1.13  thorpej 
     61  1.22   dyoung #include <sys/bus.h>
     62   1.4  thorpej #include <arm/cpufunc.h>
     63   1.1  thorpej 
     64   1.1  thorpej #include <evbarm/iq80310/iq80310reg.h>
     65   1.1  thorpej #include <evbarm/iq80310/iq80310var.h>
     66   1.1  thorpej #include <evbarm/iq80310/obiovar.h>
     67   1.1  thorpej 
     68   1.7  thorpej /*
     69   1.7  thorpej  * Some IQ80310-based designs have fewer bits in the timer counter.
     70   1.7  thorpej  * Deal with them here.
     71   1.7  thorpej  */
     72   1.7  thorpej #if defined(IOP310_TEAMASA_NPWR)
     73  1.11  thorpej #define	COUNTER_MASK		0x0007ffff
     74   1.7  thorpej #else /* Default to stock IQ80310 */
     75  1.11  thorpej #define	COUNTER_MASK		0x003fffff
     76   1.7  thorpej #endif /* list of IQ80310-based designs */
     77   1.7  thorpej 
     78   1.1  thorpej #define	COUNTS_PER_SEC		33000000	/* 33MHz */
     79   1.1  thorpej #define	COUNTS_PER_USEC		(COUNTS_PER_SEC / 1000000)
     80   1.1  thorpej 
     81   1.1  thorpej static void *clock_ih;
     82   1.1  thorpej 
     83   1.1  thorpej static uint32_t counts_per_hz;
     84   1.1  thorpej 
     85  1.21    joerg static u_int	iq80310_get_timecount(struct timecounter *);
     86  1.21    joerg 
     87  1.21    joerg static struct timecounter iq80310_timecounter = {
     88  1.23      rin 	.tc_get_timecount = iq80310_get_timecount,
     89  1.23      rin 	.tc_counter_mask = 0xffffffff,
     90  1.23      rin 	.tc_frequency = COUNTS_PER_SEC,
     91  1.23      rin 	.tc_name = "iq80310",
     92  1.23      rin 	.tc_quality = 100,
     93  1.21    joerg };
     94  1.21    joerg 
     95  1.21    joerg static volatile uint32_t iq80310_base;
     96  1.21    joerg 
     97   1.1  thorpej int	clockhandler(void *);
     98   1.1  thorpej 
     99  1.19    perry static inline void
    100   1.1  thorpej timer_enable(uint8_t bit)
    101   1.1  thorpej {
    102   1.1  thorpej 
    103   1.2  thorpej 	CPLD_WRITE(IQ80310_TIMER_ENABLE,
    104   1.2  thorpej 	    CPLD_READ(IQ80310_TIMER_ENABLE) | bit);
    105   1.1  thorpej }
    106   1.1  thorpej 
    107  1.19    perry static inline void
    108   1.1  thorpej timer_disable(uint8_t bit)
    109   1.1  thorpej {
    110   1.1  thorpej 
    111   1.2  thorpej 	CPLD_WRITE(IQ80310_TIMER_ENABLE,
    112   1.2  thorpej 	    CPLD_READ(IQ80310_TIMER_ENABLE) & ~bit);
    113   1.1  thorpej }
    114   1.1  thorpej 
    115  1.19    perry static inline uint32_t
    116   1.1  thorpej timer_read(void)
    117   1.1  thorpej {
    118   1.3  thorpej 	uint32_t rv;
    119  1.11  thorpej 	uint8_t la0, la1, la2, la3;
    120   1.1  thorpej 
    121   1.1  thorpej 	/*
    122   1.1  thorpej 	 * First read latches count.
    123   1.1  thorpej 	 *
    124  1.24   andvar 	 * From RedBoot: hardware bug that causes invalid counts to be
    125   1.1  thorpej 	 * latched.  The loop appears to work around the problem.
    126   1.1  thorpej 	 */
    127   1.1  thorpej 	do {
    128  1.11  thorpej 		la0 = CPLD_READ(IQ80310_TIMER_LA0);
    129  1.11  thorpej 	} while (la0 == 0);
    130  1.11  thorpej 	la1 = CPLD_READ(IQ80310_TIMER_LA1);
    131  1.11  thorpej 	la2 = CPLD_READ(IQ80310_TIMER_LA2);
    132  1.11  thorpej 	la3 = CPLD_READ(IQ80310_TIMER_LA3);
    133  1.11  thorpej 
    134  1.11  thorpej 	rv  =  ((la0 & 0x40) >> 1) | (la0 & 0x1f);
    135  1.11  thorpej 	rv |= (((la1 & 0x40) >> 1) | (la1 & 0x1f)) << 6;
    136  1.11  thorpej 	rv |= (((la2 & 0x40) >> 1) | (la2 & 0x1f)) << 12;
    137  1.11  thorpej 	rv |= (la3 & 0x0f) << 18;
    138   1.1  thorpej 
    139   1.3  thorpej 	return (rv);
    140   1.1  thorpej }
    141   1.1  thorpej 
    142  1.19    perry static inline void
    143   1.1  thorpej timer_write(uint32_t x)
    144   1.1  thorpej {
    145   1.7  thorpej 
    146   1.7  thorpej 	KASSERT((x & COUNTER_MASK) == x);
    147   1.1  thorpej 
    148   1.2  thorpej 	CPLD_WRITE(IQ80310_TIMER_LA0, x & 0xff);
    149   1.2  thorpej 	CPLD_WRITE(IQ80310_TIMER_LA1, (x >> 8) & 0xff);
    150   1.2  thorpej 	CPLD_WRITE(IQ80310_TIMER_LA2, (x >> 16) & 0x3f);
    151   1.1  thorpej }
    152   1.1  thorpej 
    153   1.1  thorpej /*
    154   1.1  thorpej  * iq80310_calibrate_delay:
    155   1.1  thorpej  *
    156   1.1  thorpej  *	Calibrate the delay loop.
    157   1.1  thorpej  */
    158   1.1  thorpej void
    159   1.1  thorpej iq80310_calibrate_delay(void)
    160   1.1  thorpej {
    161   1.1  thorpej 
    162   1.1  thorpej 	/*
    163   1.1  thorpej 	 * We'll use the CPLD timer for delay(), as well.  We go
    164   1.1  thorpej 	 * ahead and start it up now, just don't enable interrupts
    165   1.1  thorpej 	 * until cpu_initclocks().
    166   1.1  thorpej 	 *
    167   1.1  thorpej 	 * Just use hz=100 for now -- we'll adjust it, if necessary,
    168   1.1  thorpej 	 * in cpu_initclocks().
    169   1.1  thorpej 	 */
    170   1.1  thorpej 	counts_per_hz = COUNTS_PER_SEC / 100;
    171   1.1  thorpej 
    172   1.1  thorpej 	timer_disable(TIMER_ENABLE_INTEN);
    173   1.1  thorpej 	timer_disable(TIMER_ENABLE_EN);
    174   1.1  thorpej 
    175   1.1  thorpej 	timer_write(counts_per_hz);
    176   1.1  thorpej 
    177   1.1  thorpej 	timer_enable(TIMER_ENABLE_EN);
    178   1.1  thorpej }
    179   1.1  thorpej 
    180   1.1  thorpej /*
    181   1.1  thorpej  * cpu_initclocks:
    182   1.1  thorpej  *
    183   1.1  thorpej  *	Initialize the clock and get them going.
    184   1.1  thorpej  */
    185   1.1  thorpej void
    186   1.1  thorpej cpu_initclocks(void)
    187   1.1  thorpej {
    188   1.1  thorpej 	u_int oldirqstate;
    189   1.1  thorpej 
    190   1.1  thorpej 	if (hz < 50 || COUNTS_PER_SEC % hz) {
    191   1.1  thorpej 		printf("Cannot get %d Hz clock; using 100 Hz\n", hz);
    192   1.1  thorpej 		hz = 100;
    193   1.5  thorpej 	}
    194   1.1  thorpej 
    195   1.1  thorpej 	/*
    196   1.1  thorpej 	 * We only have one timer available; stathz and profhz are
    197   1.5  thorpej 	 * always left as 0 (the upper-layer clock code deals with
    198   1.5  thorpej 	 * this situation).
    199   1.1  thorpej 	 */
    200   1.1  thorpej 	if (stathz != 0)
    201   1.5  thorpej 		printf("Cannot get %d Hz statclock\n", stathz);
    202   1.5  thorpej 	stathz = 0;
    203   1.1  thorpej 
    204   1.1  thorpej 	if (profhz != 0)
    205   1.5  thorpej 		printf("Cannot get %d Hz profclock\n", profhz);
    206   1.5  thorpej 	profhz = 0;
    207   1.1  thorpej 
    208   1.1  thorpej 	/* Report the clock frequency. */
    209   1.1  thorpej 	printf("clock: hz=%d stathz=%d profhz=%d\n", hz, stathz, profhz);
    210   1.1  thorpej 
    211   1.1  thorpej 	/* Hook up the clock interrupt handler. */
    212   1.1  thorpej 	clock_ih = iq80310_intr_establish(XINT3_IRQ(XINT3_TIMER), IPL_CLOCK,
    213   1.1  thorpej 	    clockhandler, NULL);
    214   1.1  thorpej 	if (clock_ih == NULL)
    215   1.1  thorpej 		panic("cpu_initclocks: unable to register timer interrupt");
    216   1.1  thorpej 
    217   1.1  thorpej 	/* Set up the new clock parameters. */
    218   1.1  thorpej 	oldirqstate = disable_interrupts(I32_bit);
    219   1.1  thorpej 
    220   1.1  thorpej 	timer_disable(TIMER_ENABLE_EN);
    221   1.1  thorpej 
    222   1.1  thorpej 	counts_per_hz = COUNTS_PER_SEC / hz;
    223   1.1  thorpej 	timer_write(counts_per_hz);
    224   1.1  thorpej 
    225   1.1  thorpej 	timer_enable(TIMER_ENABLE_INTEN);
    226   1.1  thorpej 	timer_enable(TIMER_ENABLE_EN);
    227   1.1  thorpej 
    228   1.1  thorpej 	restore_interrupts(oldirqstate);
    229  1.21    joerg 
    230  1.21    joerg 	tc_init(&iq80310_timecounter);
    231   1.1  thorpej }
    232   1.1  thorpej 
    233   1.1  thorpej /*
    234   1.1  thorpej  * setstatclockrate:
    235   1.1  thorpej  *
    236   1.1  thorpej  *	Set the rate of the statistics clock.
    237   1.1  thorpej  *
    238   1.1  thorpej  *	We assume that hz is either stathz or profhz, and that neither
    239   1.1  thorpej  *	will change after being set by cpu_initclocks().  We could
    240   1.1  thorpej  *	recalculate the intervals here, but that would be a pain.
    241   1.1  thorpej  */
    242   1.1  thorpej void
    243  1.17       he setstatclockrate(int newhz)
    244   1.1  thorpej {
    245   1.1  thorpej 
    246   1.1  thorpej 	/*
    247   1.1  thorpej 	 * Nothing to do, here; we can't change the statclock
    248   1.1  thorpej 	 * rate on the IQ80310.
    249   1.1  thorpej 	 */
    250   1.1  thorpej }
    251   1.1  thorpej 
    252  1.21    joerg static u_int
    253  1.21    joerg iq80310_get_timecount(struct timecounter *tc)
    254   1.1  thorpej {
    255  1.21    joerg 	u_int oldirqstate, base, counter;
    256   1.1  thorpej 
    257   1.1  thorpej 	oldirqstate = disable_interrupts(I32_bit);
    258  1.21    joerg 	base = iq80310_base;
    259  1.21    joerg 	counter = timer_read();
    260  1.21    joerg 	restore_interrupts(oldirqstate);
    261   1.1  thorpej 
    262  1.21    joerg 	return base + counter;
    263   1.1  thorpej }
    264   1.1  thorpej 
    265   1.1  thorpej /*
    266   1.1  thorpej  * delay:
    267   1.1  thorpej  *
    268   1.1  thorpej  *	Delay for at least N microseconds.
    269   1.1  thorpej  */
    270   1.1  thorpej void
    271   1.1  thorpej delay(u_int n)
    272   1.1  thorpej {
    273   1.1  thorpej 	uint32_t cur, last, delta, usecs;
    274   1.1  thorpej 
    275   1.1  thorpej 	/*
    276   1.1  thorpej 	 * This works by polling the timer and counting the
    277   1.1  thorpej 	 * number of microseconds that go by.
    278   1.1  thorpej 	 */
    279   1.1  thorpej 	last = timer_read();
    280   1.1  thorpej 	delta = usecs = 0;
    281   1.1  thorpej 
    282   1.3  thorpej 	while (n > usecs) {
    283   1.1  thorpej 		cur = timer_read();
    284   1.1  thorpej 
    285   1.1  thorpej 		/* Check to see if the timer has wrapped around. */
    286   1.1  thorpej 		if (cur < last)
    287   1.3  thorpej 			delta += ((counts_per_hz - last) + cur);
    288   1.1  thorpej 		else
    289   1.3  thorpej 			delta += (cur - last);
    290   1.1  thorpej 
    291   1.1  thorpej 		last = cur;
    292   1.1  thorpej 
    293   1.1  thorpej 		if (delta >= COUNTS_PER_USEC) {
    294   1.1  thorpej 			usecs += delta / COUNTS_PER_USEC;
    295   1.1  thorpej 			delta %= COUNTS_PER_USEC;
    296   1.1  thorpej 		}
    297   1.1  thorpej 	}
    298   1.1  thorpej }
    299   1.1  thorpej 
    300   1.1  thorpej /*
    301   1.1  thorpej  * clockhandler:
    302   1.1  thorpej  *
    303   1.1  thorpej  *	Handle the hardclock interrupt.
    304   1.1  thorpej  */
    305   1.1  thorpej int
    306   1.1  thorpej clockhandler(void *arg)
    307   1.1  thorpej {
    308   1.1  thorpej 	struct clockframe *frame = arg;
    309   1.1  thorpej 
    310   1.1  thorpej 	timer_disable(TIMER_ENABLE_INTEN);
    311   1.1  thorpej 	timer_enable(TIMER_ENABLE_INTEN);
    312   1.1  thorpej 
    313  1.21    joerg 	atomic_add_32(&iq80310_base, counts_per_hz);
    314  1.21    joerg 
    315   1.1  thorpej 	hardclock(frame);
    316   1.6  thorpej 
    317   1.9  thorpej 	/*
    318   1.9  thorpej 	 * Don't run the snake on IOP310-based systems that
    319   1.9  thorpej 	 * don't have the 7-segment display.
    320   1.9  thorpej 	 */
    321   1.9  thorpej #if !defined(IOP310_TEAMASA_NPWR)
    322   1.9  thorpej 	{
    323   1.9  thorpej 		static int snakefreq;
    324   1.9  thorpej 
    325   1.9  thorpej 		if ((snakefreq++ & 15) == 0)
    326   1.9  thorpej 			iq80310_7seg_snake();
    327   1.9  thorpej 	}
    328   1.9  thorpej #endif
    329   1.1  thorpej 
    330   1.1  thorpej 	return (1);
    331   1.1  thorpej }
    332