sbtimer.c revision 1.16
11.16Smatt/* $NetBSD: sbtimer.c,v 1.16 2011/02/01 03:16:54 matt Exp $ */
21.1Ssimonb
31.1Ssimonb/*
41.1Ssimonb * Copyright 2000, 2001
51.1Ssimonb * Broadcom Corporation. All rights reserved.
61.1Ssimonb *
71.1Ssimonb * This software is furnished under license and may be used and copied only
81.1Ssimonb * in accordance with the following terms and conditions.  Subject to these
91.1Ssimonb * conditions, you may download, copy, install, use, modify and distribute
101.1Ssimonb * modified or unmodified copies of this software in source and/or binary
111.1Ssimonb * form. No title or ownership is transferred hereby.
121.1Ssimonb *
131.1Ssimonb * 1) Any source code used, modified or distributed must reproduce and
141.1Ssimonb *    retain this copyright notice and list of conditions as they appear in
151.1Ssimonb *    the source file.
161.1Ssimonb *
171.1Ssimonb * 2) No right is granted to use any trade name, trademark, or logo of
181.8Scgd *    Broadcom Corporation.  The "Broadcom Corporation" name may not be
191.8Scgd *    used to endorse or promote products derived from this software
201.8Scgd *    without the prior written permission of Broadcom Corporation.
211.1Ssimonb *
221.1Ssimonb * 3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR IMPLIED
231.1Ssimonb *    WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED WARRANTIES OF
241.1Ssimonb *    MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR
251.1Ssimonb *    NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM BE LIABLE
261.1Ssimonb *    FOR ANY DAMAGES WHATSOEVER, AND IN PARTICULAR, BROADCOM SHALL NOT BE
271.1Ssimonb *    LIABLE FOR DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
281.1Ssimonb *    CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
291.1Ssimonb *    SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
301.1Ssimonb *    BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
311.1Ssimonb *    WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
321.1Ssimonb *    OR OTHERWISE), EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
331.1Ssimonb */
341.9Slukem
351.9Slukem#include <sys/cdefs.h>
361.16Smatt__KERNEL_RCSID(0, "$NetBSD: sbtimer.c,v 1.16 2011/02/01 03:16:54 matt Exp $");
371.1Ssimonb
381.1Ssimonb#include <sys/param.h>
391.1Ssimonb#include <sys/device.h>
401.1Ssimonb#include <sys/systm.h>
411.1Ssimonb#include <sys/kernel.h>
421.1Ssimonb
431.1Ssimonb#include <mips/locore.h>
441.1Ssimonb
451.1Ssimonb#include <mips/sibyte/include/sb1250_regs.h>
461.1Ssimonb#include <mips/sibyte/include/sb1250_scd.h>
471.1Ssimonb#include <mips/sibyte/dev/sbscdvar.h>
481.1Ssimonb
491.1Ssimonbstruct sbtimer_softc {
501.16Smatt	device_t sc_dev;
511.1Ssimonb	void	*sc_intrhand;
521.1Ssimonb	int	sc_flags;
531.1Ssimonb	void	*sc_addr_icnt, *sc_addr_cnt, *sc_addr_cfg;
541.1Ssimonb};
551.1Ssimonb#define	SBTIMER_CLOCK		1
561.1Ssimonb#define	SBTIMER_STATCLOCK	2
571.1Ssimonb
581.15Smatt#define	READ_REG(rp)		(mips3_ld((volatile uint64_t *)(rp)))
591.15Smatt#define	WRITE_REG(rp, val)	(mips3_sd((volatile uint64_t *)(rp), (val)))
601.1Ssimonb
611.16Smattstatic int	sbtimer_match(device_t, cfdata_t, void *);
621.16Smattstatic void	sbtimer_attach(device_t, device_t, void *);
631.1Ssimonb
641.16SmattCFATTACH_DECL_NEW(sbtimer, sizeof(struct sbtimer_softc),
651.7Sthorpej    sbtimer_match, sbtimer_attach, NULL, NULL);
661.1Ssimonb
671.15Smattstatic void	sbtimer_clockintr(void *arg, uint32_t status, vaddr_t pc);
681.15Smattstatic void	sbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc);
691.15Smattstatic void	sbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc);
701.1Ssimonb
711.1Ssimonbstatic void	sbtimer_clock_init(void *arg);
721.1Ssimonb
731.1Ssimonbstatic int
741.16Smattsbtimer_match(device_t parent, cfdata_t match, void *aux)
751.1Ssimonb{
761.1Ssimonb	struct sbscd_attach_args *sap = aux;
771.1Ssimonb
781.1Ssimonb	if (sap->sa_locs.sa_type != SBSCD_DEVTYPE_TIMER)
791.1Ssimonb		return (0);
801.1Ssimonb
811.1Ssimonb	return 1;
821.1Ssimonb}
831.1Ssimonb
841.1Ssimonbstatic void
851.16Smattsbtimer_attach(device_t parent, device_t self, void *aux)
861.1Ssimonb{
871.1Ssimonb	struct sbscd_attach_args *sa = aux;
881.16Smatt	struct sbtimer_softc *sc = device_private(self);
891.15Smatt	void (*fun)(void *, uint32_t, vaddr_t);
901.1Ssimonb	int ipl;
911.1Ssimonb	const char *comment = "";
921.1Ssimonb
931.16Smatt	sc->sc_dev = self;
941.16Smatt
951.16Smatt	sc->sc_flags = device_cfdata(sc->sc_dev)->cf_flags;
961.14Ssimonb	sc->sc_addr_icnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_locs.sa_addr +
971.14Ssimonb	    R_SCD_TIMER_INIT);
981.14Ssimonb	sc->sc_addr_cnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_locs.sa_addr +
991.14Ssimonb	    R_SCD_TIMER_CNT);
1001.14Ssimonb	sc->sc_addr_cfg = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_locs.sa_addr +
1011.14Ssimonb	    R_SCD_TIMER_CFG);
1021.1Ssimonb
1031.1Ssimonb	printf(": ");
1041.1Ssimonb	if ((sc->sc_flags & SBTIMER_CLOCK) != 0) {
1051.1Ssimonb		ipl = IPL_CLOCK;
1061.1Ssimonb		fun = sbtimer_clockintr;
1071.1Ssimonb
1081.1Ssimonb		if (system_set_clockfns(sc, sbtimer_clock_init)) {
1091.1Ssimonb			/* not really the clock */
1101.1Ssimonb			sc->sc_flags &= ~SBTIMER_CLOCK;
1111.1Ssimonb			comment = " (not system timer)";
1121.1Ssimonb			goto not_really;
1131.1Ssimonb		}
1141.1Ssimonb		printf("system timer");
1151.1Ssimonb	} else if ((sc->sc_flags & SBTIMER_STATCLOCK) != 0) {
1161.12Sad		ipl = IPL_HIGH;
1171.1Ssimonb		fun = sbtimer_statclockintr;
1181.1Ssimonb
1191.1Ssimonb		/* XXX make sure it's the statclock */
1201.1Ssimonb		if (1) {
1211.1Ssimonb			/* not really the statclock */
1221.1Ssimonb			sc->sc_flags &= ~SBTIMER_STATCLOCK;
1231.1Ssimonb			comment = " (not system statistics timer)";
1241.1Ssimonb			goto not_really;
1251.1Ssimonb		}
1261.1Ssimonb		printf("system statistics timer");
1271.1Ssimonb	} else {
1281.1Ssimonbnot_really:
1291.1Ssimonb		ipl = IPL_BIO;			/* XXX -- pretty low */
1301.1Ssimonb		fun = sbtimer_miscintr;
1311.1Ssimonb		printf("general-purpose timer%s", comment);
1321.1Ssimonb	}
1331.1Ssimonb	printf("\n");
1341.1Ssimonb
1351.1Ssimonb	/* clear intr & disable timer. */
1361.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
1371.1Ssimonb
1381.1Ssimonb	sc->sc_intrhand = cpu_intr_establish(sa->sa_locs.sa_intr[0], ipl,
1391.1Ssimonb	    fun, sc);
1401.1Ssimonb}
1411.1Ssimonb
1421.1Ssimonbstatic void
1431.1Ssimonbsbtimer_clock_init(void *arg)
1441.1Ssimonb{
1451.1Ssimonb	struct sbtimer_softc *sc = arg;
1461.16Smatt	const char * const xname = device_xname(sc->sc_dev);
1471.1Ssimonb
1481.16Smatt	printf("%s: ", xname);
1491.1Ssimonb	if ((1000000 % hz) == 0)
1501.1Ssimonb		printf("%dHz system timer\n", hz);
1511.1Ssimonb	else {
1521.1Ssimonb		printf("cannot get %dHz clock; using 1000Hz\n", hz);
1531.1Ssimonb		hz = 1000;
1541.1Ssimonb		tick = 1000000 / hz;
1551.1Ssimonb	}
1561.1Ssimonb
1571.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
1581.1Ssimonb	if (G_SYS_PLL_DIV(READ_REG(MIPS_PHYS_TO_KSEG1(A_SCD_SYSTEM_CFG))) == 0) {
1591.2Ssimonb		printf("%s: PLL_DIV == 0; speeding up clock ticks for simulator\n",
1601.16Smatt		    xname);
1611.1Ssimonb		WRITE_REG(sc->sc_addr_icnt, (tick/100) - 1); /* XXX */
1621.1Ssimonb	} else {
1631.1Ssimonb		WRITE_REG(sc->sc_addr_icnt, tick - 1);	/* XXX */
1641.1Ssimonb	}
1651.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x03);		/* XXX */
1661.1Ssimonb}
1671.1Ssimonb
1681.1Ssimonbstatic void
1691.15Smattsbtimer_clockintr(void *arg, uint32_t status, vaddr_t pc)
1701.1Ssimonb{
1711.1Ssimonb	struct sbtimer_softc *sc = arg;
1721.1Ssimonb	struct clockframe cf;
1731.1Ssimonb
1741.1Ssimonb	/* clear interrupt, but leave timer enabled and in repeating mode */
1751.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x03);		/* XXX */
1761.1Ssimonb
1771.1Ssimonb	cf.pc = pc;
1781.1Ssimonb	cf.sr = status;
1791.3Ssimonb
1801.13Ssimonb	hardclock(&cf);
1811.1Ssimonb
1821.13Ssimonb	/*
1831.13Ssimonb	 * We never want a CPU core clock interrupt, so adjust the CP0
1841.13Ssimonb	 * compare register to just before the CP0 clock register's value
1851.13Ssimonb	 * each time.
1861.13Ssimonb	 */
1871.13Ssimonb	mips3_cp0_compare_write(mips3_cp0_count_read() - 1);
1881.1Ssimonb}
1891.1Ssimonb
1901.1Ssimonbstatic void
1911.15Smattsbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc)
1921.1Ssimonb{
1931.1Ssimonb	struct sbtimer_softc *sc = arg;
1941.1Ssimonb	struct clockframe cf;
1951.1Ssimonb
1961.1Ssimonb	/* clear intr & disable timer, reset initial count, re-enable timer */
1971.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
1981.1Ssimonb	/* XXX more to do */
1991.1Ssimonb
2001.1Ssimonb	cf.pc = pc;
2011.1Ssimonb	cf.sr = status;
2021.1Ssimonb
2031.1Ssimonb	statclock(&cf);
2041.1Ssimonb}
2051.1Ssimonb
2061.1Ssimonbstatic void
2071.15Smattsbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc)
2081.1Ssimonb{
2091.1Ssimonb	struct sbtimer_softc *sc = arg;
2101.1Ssimonb
2111.1Ssimonb	/* disable timer */
2121.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
2131.1Ssimonb
2141.1Ssimonb	/* XXX more to do */
2151.1Ssimonb}
216