sbtimer.c revision 1.20
11.20Schristos/* $NetBSD: sbtimer.c,v 1.20 2016/07/21 17:02:47 christos 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.20Schristos__KERNEL_RCSID(0, "$NetBSD: sbtimer.c,v 1.20 2016/07/21 17:02:47 christos 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.19Stsutsui#include <sys/cpu.h>
431.1Ssimonb
441.1Ssimonb#include <mips/locore.h>
451.1Ssimonb
461.1Ssimonb#include <mips/sibyte/include/sb1250_regs.h>
471.1Ssimonb#include <mips/sibyte/include/sb1250_scd.h>
481.1Ssimonb#include <mips/sibyte/dev/sbscdvar.h>
491.1Ssimonb
501.1Ssimonbstruct sbtimer_softc {
511.16Smatt	device_t sc_dev;
521.1Ssimonb	void	*sc_intrhand;
531.1Ssimonb	int	sc_flags;
541.1Ssimonb	void	*sc_addr_icnt, *sc_addr_cnt, *sc_addr_cfg;
551.1Ssimonb};
561.1Ssimonb#define	SBTIMER_CLOCK		1
571.1Ssimonb#define	SBTIMER_STATCLOCK	2
581.1Ssimonb
591.20Schristos#define	READ_REG(rp)		mips3_ld((register_t)(rp))
601.20Schristos#define	WRITE_REG(rp, val)	mips3_sd((register_t)(rp), (val))
611.1Ssimonb
621.16Smattstatic int	sbtimer_match(device_t, cfdata_t, void *);
631.16Smattstatic void	sbtimer_attach(device_t, device_t, void *);
641.1Ssimonb
651.16SmattCFATTACH_DECL_NEW(sbtimer, sizeof(struct sbtimer_softc),
661.7Sthorpej    sbtimer_match, sbtimer_attach, NULL, NULL);
671.1Ssimonb
681.15Smattstatic void	sbtimer_clockintr(void *arg, uint32_t status, vaddr_t pc);
691.15Smattstatic void	sbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc);
701.15Smattstatic void	sbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc);
711.1Ssimonb
721.1Ssimonbstatic void	sbtimer_clock_init(void *arg);
731.1Ssimonb
741.1Ssimonbstatic int
751.16Smattsbtimer_match(device_t parent, cfdata_t match, void *aux)
761.1Ssimonb{
771.1Ssimonb	struct sbscd_attach_args *sap = aux;
781.1Ssimonb
791.1Ssimonb	if (sap->sa_locs.sa_type != SBSCD_DEVTYPE_TIMER)
801.1Ssimonb		return (0);
811.1Ssimonb
821.1Ssimonb	return 1;
831.1Ssimonb}
841.1Ssimonb
851.1Ssimonbstatic void
861.16Smattsbtimer_attach(device_t parent, device_t self, void *aux)
871.1Ssimonb{
881.1Ssimonb	struct sbscd_attach_args *sa = aux;
891.16Smatt	struct sbtimer_softc *sc = device_private(self);
901.15Smatt	void (*fun)(void *, uint32_t, vaddr_t);
911.1Ssimonb	int ipl;
921.1Ssimonb	const char *comment = "";
931.1Ssimonb
941.16Smatt	sc->sc_dev = self;
951.16Smatt
961.16Smatt	sc->sc_flags = device_cfdata(sc->sc_dev)->cf_flags;
971.18Smatt	sc->sc_addr_icnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
981.18Smatt	    sa->sa_locs.sa_offset + R_SCD_TIMER_INIT);
991.18Smatt	sc->sc_addr_cnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
1001.18Smatt	    sa->sa_locs.sa_offset + R_SCD_TIMER_CNT);
1011.18Smatt	sc->sc_addr_cfg = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
1021.18Smatt	    sa->sa_locs.sa_offset + R_SCD_TIMER_CFG);
1031.1Ssimonb
1041.17Smatt	aprint_normal(": ");
1051.1Ssimonb	if ((sc->sc_flags & SBTIMER_CLOCK) != 0) {
1061.1Ssimonb		ipl = IPL_CLOCK;
1071.1Ssimonb		fun = sbtimer_clockintr;
1081.1Ssimonb
1091.1Ssimonb		if (system_set_clockfns(sc, sbtimer_clock_init)) {
1101.1Ssimonb			/* not really the clock */
1111.1Ssimonb			sc->sc_flags &= ~SBTIMER_CLOCK;
1121.1Ssimonb			comment = " (not system timer)";
1131.1Ssimonb			goto not_really;
1141.1Ssimonb		}
1151.17Smatt		aprint_normal("system timer");
1161.1Ssimonb	} else if ((sc->sc_flags & SBTIMER_STATCLOCK) != 0) {
1171.12Sad		ipl = IPL_HIGH;
1181.1Ssimonb		fun = sbtimer_statclockintr;
1191.1Ssimonb
1201.1Ssimonb		/* XXX make sure it's the statclock */
1211.1Ssimonb		if (1) {
1221.1Ssimonb			/* not really the statclock */
1231.1Ssimonb			sc->sc_flags &= ~SBTIMER_STATCLOCK;
1241.1Ssimonb			comment = " (not system statistics timer)";
1251.1Ssimonb			goto not_really;
1261.1Ssimonb		}
1271.17Smatt		aprint_normal("system statistics timer");
1281.1Ssimonb	} else {
1291.1Ssimonbnot_really:
1301.1Ssimonb		ipl = IPL_BIO;			/* XXX -- pretty low */
1311.1Ssimonb		fun = sbtimer_miscintr;
1321.17Smatt		aprint_normal("general-purpose timer%s", comment);
1331.1Ssimonb	}
1341.17Smatt	aprint_normal("\n");
1351.1Ssimonb
1361.1Ssimonb	/* clear intr & disable timer. */
1371.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
1381.1Ssimonb
1391.1Ssimonb	sc->sc_intrhand = cpu_intr_establish(sa->sa_locs.sa_intr[0], ipl,
1401.1Ssimonb	    fun, sc);
1411.1Ssimonb}
1421.1Ssimonb
1431.1Ssimonbstatic void
1441.1Ssimonbsbtimer_clock_init(void *arg)
1451.1Ssimonb{
1461.1Ssimonb	struct sbtimer_softc *sc = arg;
1471.1Ssimonb
1481.17Smatt	if ((1000000 % hz) == 0) {
1491.17Smatt		aprint_normal_dev(sc->sc_dev, "%dHz system timer\n", hz);
1501.17Smatt	} else {
1511.17Smatt		aprint_error_dev(sc->sc_dev,
1521.17Smatt		    "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.17Smatt		aprint_debug_dev(sc->sc_dev,
1601.17Smatt		    "PLL_DIV == 0; speeding up clock ticks for simulator\n");
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.19Stsutsui	cf.intr = (curcpu()->ci_idepth > 1);
1801.3Ssimonb
1811.13Ssimonb	hardclock(&cf);
1821.1Ssimonb
1831.13Ssimonb	/*
1841.13Ssimonb	 * We never want a CPU core clock interrupt, so adjust the CP0
1851.13Ssimonb	 * compare register to just before the CP0 clock register's value
1861.13Ssimonb	 * each time.
1871.13Ssimonb	 */
1881.13Ssimonb	mips3_cp0_compare_write(mips3_cp0_count_read() - 1);
1891.1Ssimonb}
1901.1Ssimonb
1911.1Ssimonbstatic void
1921.15Smattsbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc)
1931.1Ssimonb{
1941.1Ssimonb	struct sbtimer_softc *sc = arg;
1951.1Ssimonb	struct clockframe cf;
1961.1Ssimonb
1971.1Ssimonb	/* clear intr & disable timer, reset initial count, re-enable timer */
1981.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
1991.1Ssimonb	/* XXX more to do */
2001.1Ssimonb
2011.1Ssimonb	cf.pc = pc;
2021.1Ssimonb	cf.sr = status;
2031.1Ssimonb
2041.1Ssimonb	statclock(&cf);
2051.1Ssimonb}
2061.1Ssimonb
2071.1Ssimonbstatic void
2081.15Smattsbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc)
2091.1Ssimonb{
2101.1Ssimonb	struct sbtimer_softc *sc = arg;
2111.1Ssimonb
2121.1Ssimonb	/* disable timer */
2131.1Ssimonb	WRITE_REG(sc->sc_addr_cfg, 0x00);		/* XXX */
2141.1Ssimonb
2151.1Ssimonb	/* XXX more to do */
2161.1Ssimonb}
217