Home | History | Annotate | Line # | Download | only in ebus
      1  1.9   thorpej /*	$NetBSD: clock_ebus.c,v 1.9 2025/09/07 21:45:12 thorpej Exp $	*/
      2  1.1     pooka 
      3  1.1     pooka /*-
      4  1.1     pooka  * Copyright (c) 2010 The NetBSD Foundation, Inc.
      5  1.1     pooka  * All rights reserved.
      6  1.1     pooka  *
      7  1.1     pooka  * This code was written by Alessandro Forin and Neil Pittman
      8  1.1     pooka  * at Microsoft Research and contributed to The NetBSD Foundation
      9  1.1     pooka  * by Microsoft Corporation.
     10  1.1     pooka  *
     11  1.1     pooka  * Redistribution and use in source and binary forms, with or without
     12  1.1     pooka  * modification, are permitted provided that the following conditions
     13  1.1     pooka  * are met:
     14  1.1     pooka  * 1. Redistributions of source code must retain the above copyright
     15  1.1     pooka  *    notice, this list of conditions and the following disclaimer.
     16  1.1     pooka  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.1     pooka  *    notice, this list of conditions and the following disclaimer in the
     18  1.1     pooka  *    documentation and/or other materials provided with the distribution.
     19  1.1     pooka  *
     20  1.1     pooka  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21  1.1     pooka  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22  1.1     pooka  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23  1.1     pooka  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24  1.1     pooka  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25  1.1     pooka  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26  1.1     pooka  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27  1.1     pooka  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28  1.1     pooka  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29  1.1     pooka  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30  1.1     pooka  * POSSIBILITY OF SUCH DAMAGE.
     31  1.1     pooka  */
     32  1.1     pooka 
     33  1.1     pooka #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     34  1.9   thorpej __KERNEL_RCSID(0, "$NetBSD: clock_ebus.c,v 1.9 2025/09/07 21:45:12 thorpej Exp $");
     35  1.1     pooka 
     36  1.1     pooka #include <sys/param.h>
     37  1.1     pooka #include <sys/kernel.h>
     38  1.1     pooka #include <sys/device.h>
     39  1.1     pooka #include <sys/systm.h>
     40  1.1     pooka #include <sys/timetc.h>
     41  1.1     pooka 
     42  1.1     pooka #include <dev/clock_subr.h>
     43  1.1     pooka 
     44  1.1     pooka #include <emips/ebus/ebusvar.h>
     45  1.1     pooka #include <emips/emips/machdep.h>
     46  1.1     pooka #include <machine/emipsreg.h>
     47  1.1     pooka 
     48  1.1     pooka /*
     49  1.1     pooka  * Device softc
     50  1.1     pooka  */
     51  1.1     pooka struct eclock_softc {
     52  1.6   tsutsui 	device_t sc_dev;
     53  1.1     pooka 	struct _Tc *sc_dp;
     54  1.4   tsutsui 	uint32_t sc_reload;
     55  1.2   tsutsui 	struct timecounter sc_tc;
     56  1.2   tsutsui 	struct todr_chip_handle sc_todr;
     57  1.1     pooka };
     58  1.1     pooka 
     59  1.2   tsutsui static int	eclock_ebus_match(device_t, cfdata_t, void *);
     60  1.2   tsutsui static void	eclock_ebus_attach(device_t, device_t, void *);
     61  1.1     pooka 
     62  1.6   tsutsui CFATTACH_DECL_NEW(eclock_ebus, sizeof (struct eclock_softc),
     63  1.1     pooka     eclock_ebus_match, eclock_ebus_attach, NULL, NULL);
     64  1.1     pooka 
     65  1.2   tsutsui void	eclock_init(device_t);
     66  1.1     pooka 
     67  1.2   tsutsui static void	__eclock_init(device_t);
     68  1.2   tsutsui static int	eclock_gettime(struct todr_chip_handle *, struct timeval *);
     69  1.2   tsutsui static int	eclock_settime(struct todr_chip_handle *, struct timeval *);
     70  1.2   tsutsui static int	eclock_ebus_intr(void *, void *);
     71  1.2   tsutsui static u_int	eclock_counter(struct timecounter *);
     72  1.2   tsutsui 
     73  1.2   tsutsui /* BUGBUG resolve the gap between cpu_initclocks() and eclock_init(x) */
     74  1.2   tsutsui device_t clockdev = NULL;
     75  1.1     pooka 
     76  1.1     pooka void
     77  1.2   tsutsui eclock_init(device_t dev)
     78  1.1     pooka {
     79  1.2   tsutsui 
     80  1.2   tsutsui 	if (dev == NULL)
     81  1.2   tsutsui 		dev = clockdev;
     82  1.2   tsutsui 	if (dev == NULL)
     83  1.2   tsutsui 		panic("eclock_init");
     84  1.2   tsutsui 	__eclock_init(dev);
     85  1.1     pooka }
     86  1.1     pooka 
     87  1.1     pooka static void
     88  1.2   tsutsui __eclock_init(device_t dev)
     89  1.1     pooka {
     90  1.6   tsutsui 	struct eclock_softc *sc = device_private(dev);
     91  1.2   tsutsui 	struct _Tc *tc = sc->sc_dp;
     92  1.4   tsutsui 	uint32_t reload = 10 * 1000000; /* 1sec in 100ns units (10MHz clock) */
     93  1.1     pooka 
     94  1.2   tsutsui 	/*
     95  1.2   tsutsui 	 * Compute reload according to whatever value passed in,
     96  1.2   tsutsui 	 * Warn if fractional
     97  1.2   tsutsui 	 */
     98  1.2   tsutsui 	if (hz > 1) {
     99  1.2   tsutsui 		uint32_t r = reload / hz;
    100  1.2   tsutsui 		if ((r * hz) != reload)
    101  1.2   tsutsui 			printf("%s: %d Hz clock will cause roundoffs"
    102  1.2   tsutsui 			    " with 10MHz xtal (%d)\n",
    103  1.6   tsutsui 			    device_xname(sc->sc_dev), hz, reload - (r * hz));
    104  1.1     pooka 		reload = r;
    105  1.1     pooka 	}
    106  1.1     pooka 
    107  1.4   tsutsui 	sc->sc_reload = reload;
    108  1.1     pooka 
    109  1.2   tsutsui 	/* Start the counter */
    110  1.2   tsutsui 	tc->DownCounterHigh = 0;
    111  1.4   tsutsui 	tc->DownCounter = sc->sc_reload;
    112  1.2   tsutsui 	tc->Control = TCCT_ENABLE | TCCT_INT_ENABLE;
    113  1.1     pooka }
    114  1.1     pooka 
    115  1.1     pooka /*
    116  1.1     pooka  * Get the time of day, based on the clock's value and/or the base value.
    117  1.1     pooka  * NB: At 10MHz, our 64bits FreeRunning is worth 58,426 years.
    118  1.1     pooka  */
    119  1.1     pooka 
    120  1.1     pooka 
    121  1.1     pooka static int
    122  1.1     pooka eclock_gettime(struct todr_chip_handle *todr, struct timeval *tv)
    123  1.1     pooka {
    124  1.9   thorpej 	struct eclock_softc *sc = device_private(todr->todr_dev);
    125  1.2   tsutsui 	struct _Tc *tc = sc->sc_dp;
    126  1.2   tsutsui 	uint64_t free;
    127  1.2   tsutsui 	int s;
    128  1.2   tsutsui 
    129  1.2   tsutsui 	/*
    130  1.2   tsutsui 	 * 32bit processor, guard against interrupts in the middle of
    131  1.2   tsutsui 	 * reading this 64bit entity
    132  1.2   tsutsui 	 */
    133  1.2   tsutsui 	/* BUGBUG Should read it "twice" to guard against rollover too. */
    134  1.1     pooka 	s = splhigh();
    135  1.2   tsutsui 	free = tc->FreeRunning;
    136  1.1     pooka 	splx(s);
    137  1.1     pooka 
    138  1.2   tsutsui 	/*
    139  1.2   tsutsui 	 * Big fight with the compiler here, it gets very confused by 64bits.
    140  1.2   tsutsui 	 */
    141  1.8    martin #if 1
    142  1.2   tsutsui 	/*
    143  1.2   tsutsui 	 * This is in C:
    144  1.2   tsutsui 	 */
    145  1.2   tsutsui 	{
    146  1.2   tsutsui 		uint64_t freeS, freeU;
    147  1.8    martin 		freeS = free / 10000000UL;
    148  1.8    martin 		freeU = free % 10000000UL;
    149  1.2   tsutsui 		tv->tv_sec  = freeS;
    150  1.2   tsutsui 		tv->tv_usec = freeU / 10;
    151  1.2   tsutsui #if 0
    152  1.2   tsutsui 		printf("egt: s x%" PRIx64 " u x%lx (fs %" PRId64
    153  1.2   tsutsui 		    " fu %" PRId64 " f %" PRId64 ")\n",
    154  1.2   tsutsui 		    tv->tv_sec, tv->tv_usec, freeS, freeU, free);
    155  1.2   tsutsui #endif
    156  1.2   tsutsui 	}
    157  1.1     pooka #else
    158  1.2   tsutsui 	/*
    159  1.2   tsutsui 	 * And this is in assembly :-)
    160  1.2   tsutsui 	 */
    161  1.2   tsutsui 	{
    162  1.2   tsutsui 		u_quad_t r;
    163  1.2   tsutsui 		u_quad_t d = __qdivrem(free,(u_quad_t)10000000,&r);
    164  1.2   tsutsui 		uint32_t su, uu;
    165  1.2   tsutsui 		su = (uint32_t)d;
    166  1.2   tsutsui 		uu = (uint32_t)r;
    167  1.2   tsutsui 		uu = uu / 10;	/* in usecs */
    168  1.2   tsutsui 		tv->tv_sec  = su;
    169  1.2   tsutsui 		tv->tv_usec = uu;
    170  1.2   tsutsui #if 0
    171  1.2   tsutsui 		printf("egt: s x%" PRIx64 " u x%lx (fs %" PRId64
    172  1.2   tsutsui 		    " fu %" PRId64 " f %" PRId64 ")\n",
    173  1.2   tsutsui 		    tv->tv_sec, tv->tv_usec, d, r, free);
    174  1.2   tsutsui #endif
    175  1.2   tsutsui 	}
    176  1.1     pooka #endif
    177  1.1     pooka 
    178  1.2   tsutsui 	return 0;
    179  1.1     pooka }
    180  1.1     pooka 
    181  1.1     pooka /*
    182  1.1     pooka  * Reset the TODR based on the time value.
    183  1.1     pooka  */
    184  1.1     pooka static int
    185  1.1     pooka eclock_settime(struct todr_chip_handle *todr, struct timeval *tv)
    186  1.1     pooka {
    187  1.9   thorpej 	struct eclock_softc *sc = device_private(todr->todr_dev);
    188  1.2   tsutsui 	struct _Tc *tc = sc->sc_dp;
    189  1.4   tsutsui 	uint64_t free, su;
    190  1.4   tsutsui 	uint32_t uu;
    191  1.2   tsutsui 	int s;
    192  1.1     pooka 
    193  1.2   tsutsui 	/* Careful with what we do here, else the compilerbugs hit hard */
    194  1.1     pooka 	s = splhigh();
    195  1.1     pooka 
    196  1.4   tsutsui 	su = (uint64_t)tv->tv_sec;	/* 0(tv) */
    197  1.4   tsutsui 	uu = (uint32_t)tv->tv_usec;	/* 8(tv) */
    198  1.1     pooka 
    199  1.1     pooka 
    200  1.4   tsutsui 	free  = su * 10 * 1000 * 1000;
    201  1.2   tsutsui 	free += uu * 10;
    202  1.1     pooka 
    203  1.2   tsutsui 	tc->FreeRunning = free;
    204  1.1     pooka 	splx(s);
    205  1.1     pooka 
    206  1.1     pooka #if 0
    207  1.2   tsutsui /*
    208  1.1     pooka Should compile to something like this:
    209  1.1     pooka 80260c84 <eclock_settime>:
    210  1.1     pooka 80260c84:	27bdffc0 	addiu	sp,sp,-64
    211  1.1     pooka 80260c88:	afbf0038 	sw	ra,56(sp)
    212  1.1     pooka 80260c8c:	afb40030 	sw	s4,48(sp)
    213  1.1     pooka 80260c90:	afb3002c 	sw	s3,44(sp)
    214  1.1     pooka 80260c94:	afb20028 	sw	s2,40(sp)
    215  1.1     pooka 80260c98:	afb10024 	sw	s1,36(sp)
    216  1.1     pooka 80260c9c:	afb00020 	sw	s0,32(sp)
    217  1.1     pooka 80260ca0:	afb50034 	sw	s5,52(sp)
    218  1.1     pooka 80260ca4:	8c820000 	lw	v0,0(a0)
    219  1.1     pooka 80260ca8:	00a09021 	move	s2,a1
    220  1.1     pooka 80260cac:	8c55003c 	lw	s5,60(v0)        //s5=tc
    221  1.1     pooka 80260cb0:	0c004122 	jal	80010488 <_splraise>
    222  1.1     pooka 80260cb4:	3404ff00 	li	a0,0xff00
    223  1.1     pooka 80260cb8:	8e540000 	lw	s4,0(s2)         //s4=tv->tv_sec=us
    224  1.1     pooka 80260cbc:	3c060098 	lui	a2,0x98
    225  1.1     pooka 80260cc0:	34c69680 	ori	a2,a2,0x9680     //a2=10000000
    226  1.1     pooka 80260cc4:	02860019 	multu	s4,a2        //free=us*10000000
    227  1.1     pooka 80260cc8:	8e530004 	lw	s3,4(s2)         //s3=uu
    228  1.1     pooka 80260ccc:	00402021 	move	a0,v0        //s=splhigh()
    229  1.1     pooka 80260cd0:	001328c0 	sll	a1,s3,0x3
    230  1.1     pooka 80260cd4:	00131040 	sll	v0,s3,0x1
    231  1.1     pooka 80260cd8:	00451021 	addu	v0,v0,a1
    232  1.1     pooka 80260cdc:	00401821 	move	v1,v0        //v1 = uu*10
    233  1.1     pooka 80260ce0:	00001021 	move	v0,zero
    234  1.1     pooka 80260ce4:	00003812 	mflo	a3           //a3=low(free)
    235  1.1     pooka 80260ce8:	00e38821 	addu	s1,a3,v1     //s1=low(free)+(uu*10)
    236  1.1     pooka 80260cec:	0227282b 	sltu	a1,s1,a3     //a1=overflow bit
    237  1.1     pooka 80260cf0:	00003010 	mfhi	a2           //a2=high(free)
    238  1.1     pooka 80260cf4:	00c28021 	addu	s0,a2,v0     //s0=a2=high(free) [useless, v0=0]
    239  1.1     pooka 80260cf8:	00b08021 	addu	s0,a1,s0     //s0+=overflow bit
    240  1.1     pooka 80260cfc:	aeb1000c 	sw	s1,12(s5)
    241  1.1     pooka 80260d00:	aeb00008 	sw	s0,8(s5)
    242  1.1     pooka 80260d04:	0c00413f 	jal	800104fc <_splset>
    243  1.1     pooka 80260d08:	00000000 	nop
    244  1.2   tsutsui */
    245  1.2   tsutsui #endif
    246  1.1     pooka 
    247  1.2   tsutsui #if 0
    248  1.2   tsutsui 	printf("est: s x%" PRIx64 " u x%lx (%d %d), free %" PRId64 "\n",
    249  1.2   tsutsui 	    tv->tv_sec, tv->tv_usec, su, uu, free);
    250  1.1     pooka #endif
    251  1.1     pooka 
    252  1.2   tsutsui 	return 0;
    253  1.1     pooka }
    254  1.1     pooka 
    255  1.1     pooka static int
    256  1.1     pooka eclock_ebus_intr(void *cookie, void *f)
    257  1.1     pooka {
    258  1.1     pooka 	struct eclock_softc *sc = cookie;
    259  1.2   tsutsui 	struct _Tc *tc = sc->sc_dp;
    260  1.2   tsutsui 	struct clockframe *cf = f;
    261  1.7  christos 	volatile uint32_t x __unused;
    262  1.2   tsutsui 
    263  1.2   tsutsui 	x = tc->Control;
    264  1.2   tsutsui 	tc->DownCounterHigh = 0;
    265  1.4   tsutsui 	tc->DownCounter = sc->sc_reload;
    266  1.1     pooka 
    267  1.2   tsutsui 	hardclock(cf);
    268  1.2   tsutsui 	emips_clock_evcnt.ev_count++;
    269  1.1     pooka 
    270  1.2   tsutsui 	return 0;
    271  1.1     pooka }
    272  1.1     pooka 
    273  1.1     pooka static u_int
    274  1.1     pooka eclock_counter(struct timecounter *tc)
    275  1.1     pooka {
    276  1.1     pooka 	struct eclock_softc *sc = tc->tc_priv;
    277  1.2   tsutsui 	struct _Tc *Tc = sc->sc_dp;
    278  1.2   tsutsui 
    279  1.2   tsutsui 	return (u_int)Tc->FreeRunning; /* NB: chops to 32bits */
    280  1.1     pooka }
    281  1.1     pooka 
    282  1.1     pooka 
    283  1.1     pooka static int
    284  1.2   tsutsui eclock_ebus_match(device_t parent, cfdata_t cf, void *aux)
    285  1.1     pooka {
    286  1.1     pooka 	struct ebus_attach_args *ia = aux;
    287  1.2   tsutsui 	struct _Tc *mc = (struct _Tc *)ia->ia_vaddr;
    288  1.1     pooka 
    289  1.1     pooka 	if (strcmp("eclock", ia->ia_name) != 0)
    290  1.2   tsutsui 		return 0;
    291  1.2   tsutsui 	if ((mc == NULL) ||
    292  1.2   tsutsui 	    (mc->Tag != PMTTAG_TIMER))
    293  1.2   tsutsui 		return 0;
    294  1.1     pooka 
    295  1.2   tsutsui 	return 1;
    296  1.1     pooka }
    297  1.1     pooka 
    298  1.1     pooka static void
    299  1.2   tsutsui eclock_ebus_attach(device_t parent, device_t self, void *aux)
    300  1.1     pooka {
    301  1.6   tsutsui 	struct eclock_softc *sc = device_private(self);
    302  1.2   tsutsui 	struct ebus_attach_args *ia = aux;
    303  1.1     pooka 
    304  1.6   tsutsui 	sc->sc_dev = self;
    305  1.2   tsutsui 	sc->sc_dp = (struct _Tc *)ia->ia_vaddr;
    306  1.1     pooka 
    307  1.2   tsutsui 	/* NB: We are chopping our 64bit free-running down to 32bits */
    308  1.2   tsutsui 	sc->sc_tc.tc_get_timecount = eclock_counter;
    309  1.2   tsutsui 	sc->sc_tc.tc_poll_pps = 0;
    310  1.2   tsutsui 	sc->sc_tc.tc_counter_mask = 0xffffffff;
    311  1.5   tsutsui 	sc->sc_tc.tc_frequency = 10 * 1000 * 1000; /* 10 MHz */
    312  1.2   tsutsui 	sc->sc_tc.tc_name = "eclock"; /* BUGBUG is it unique per instance?? */
    313  1.2   tsutsui 	sc->sc_tc.tc_quality = 2000; /* uhu? */
    314  1.2   tsutsui 	sc->sc_tc.tc_priv = sc;
    315  1.2   tsutsui 	sc->sc_tc.tc_next = NULL;
    316  1.1     pooka 
    317  1.1     pooka #if DEBUG
    318  1.2   tsutsui 	printf(" virt=%p ", (void *)sc->sc_dp);
    319  1.1     pooka #endif
    320  1.1     pooka 	printf(": eMIPS clock\n");
    321  1.1     pooka 
    322  1.1     pooka 	/* Turn interrupts off, just in case. */
    323  1.2   tsutsui 	sc->sc_dp->Control &= ~(TCCT_INT_ENABLE|TCCT_INTERRUPT);
    324  1.1     pooka 
    325  1.1     pooka 	ebus_intr_establish(parent, (void *)ia->ia_cookie, IPL_CLOCK,
    326  1.1     pooka 	    eclock_ebus_intr, sc);
    327  1.1     pooka 
    328  1.1     pooka #ifdef EVCNT_COUNTERS
    329  1.1     pooka 	evcnt_attach_dynamic(&clock_intr_evcnt, EVCNT_TYPE_INTR, NULL,
    330  1.6   tsutsui 	    device_xname(self), "intr");
    331  1.1     pooka #endif
    332  1.1     pooka 
    333  1.2   tsutsui 	clockdev = self;
    334  1.5   tsutsui 	memset(&sc->sc_todr, 0, sizeof sc->sc_todr);
    335  1.9   thorpej 	sc->sc_todr.todr_dev = self;
    336  1.2   tsutsui 	sc->sc_todr.todr_gettime = eclock_gettime;
    337  1.2   tsutsui 	sc->sc_todr.todr_settime = eclock_settime;
    338  1.2   tsutsui 	todr_attach(&sc->sc_todr);
    339  1.1     pooka 
    340  1.2   tsutsui 	tc_init(&sc->sc_tc);
    341  1.1     pooka }
    342