Home | History | Annotate | Line # | Download | only in tx
tx39clock.c revision 1.21
      1  1.21  gdamore /*	$NetBSD: tx39clock.c,v 1.21 2006/09/16 02:14:57 gdamore Exp $ */
      2   1.1      uch 
      3   1.6      uch /*-
      4  1.11      uch  * Copyright (c) 1999-2002 The NetBSD Foundation, Inc.
      5   1.1      uch  * All rights reserved.
      6   1.1      uch  *
      7   1.6      uch  * This code is derived from software contributed to The NetBSD Foundation
      8   1.6      uch  * by UCHIYAMA Yasushi.
      9   1.6      uch  *
     10   1.1      uch  * Redistribution and use in source and binary forms, with or without
     11   1.1      uch  * modification, are permitted provided that the following conditions
     12   1.1      uch  * are met:
     13   1.1      uch  * 1. Redistributions of source code must retain the above copyright
     14   1.1      uch  *    notice, this list of conditions and the following disclaimer.
     15   1.6      uch  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.6      uch  *    notice, this list of conditions and the following disclaimer in the
     17   1.6      uch  *    documentation and/or other materials provided with the distribution.
     18   1.6      uch  * 3. All advertising materials mentioning features or use of this software
     19   1.6      uch  *    must display the following acknowledgement:
     20   1.6      uch  *        This product includes software developed by the NetBSD
     21   1.6      uch  *        Foundation, Inc. and its contributors.
     22   1.6      uch  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.6      uch  *    contributors may be used to endorse or promote products derived
     24   1.6      uch  *    from this software without specific prior written permission.
     25   1.1      uch  *
     26   1.6      uch  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.6      uch  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.6      uch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.6      uch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.6      uch  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.6      uch  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.6      uch  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.6      uch  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.6      uch  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.6      uch  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.6      uch  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1      uch  */
     38  1.14    lukem 
     39  1.14    lukem #include <sys/cdefs.h>
     40  1.21  gdamore __KERNEL_RCSID(0, "$NetBSD: tx39clock.c,v 1.21 2006/09/16 02:14:57 gdamore Exp $");
     41   1.6      uch 
     42  1.11      uch #include "opt_tx39clock_debug.h"
     43   1.1      uch 
     44   1.1      uch #include <sys/param.h>
     45   1.1      uch #include <sys/systm.h>
     46  1.21  gdamore #include <sys/timetc.h>
     47   1.1      uch 
     48   1.3      uch #include <dev/clock_subr.h>
     49   1.3      uch 
     50   1.1      uch #include <machine/bus.h>
     51  1.10      uch #include <machine/sysconf.h>
     52   1.1      uch 
     53   1.1      uch #include <hpcmips/tx/tx39var.h>
     54   1.3      uch #include <hpcmips/tx/tx39icureg.h>
     55   1.5      uch #include <hpcmips/tx/tx39clockvar.h>
     56   1.1      uch #include <hpcmips/tx/tx39clockreg.h>
     57   1.1      uch #include <hpcmips/tx/tx39timerreg.h>
     58   1.3      uch 
     59  1.11      uch #ifdef	TX39CLOCK_DEBUG
     60  1.11      uch #define DPRINTF_ENABLE
     61  1.11      uch #define DPRINTF_DEBUG	tx39clock_debug
     62   1.3      uch #endif
     63  1.11      uch #include <machine/debug.h>
     64   1.3      uch 
     65  1.11      uch #define ISSETPRINT(r, m)						\
     66  1.11      uch 	dbg_bitmask_print(r, TX39_CLOCK_EN ## m ## CLK, #m)
     67   1.1      uch 
     68   1.6      uch void	tx39clock_init(struct device *);
     69   1.3      uch 
     70  1.10      uch struct platform_clock tx39_clock = {
     71  1.10      uch #define CLOCK_RATE	100
     72  1.21  gdamore 	CLOCK_RATE, tx39clock_init,
     73   1.3      uch };
     74   1.1      uch 
     75   1.3      uch struct txtime {
     76   1.3      uch 	u_int32_t t_hi;
     77   1.3      uch 	u_int32_t t_lo;
     78   1.3      uch };
     79   1.3      uch 
     80   1.3      uch struct tx39clock_softc {
     81   1.3      uch 	struct	device sc_dev;
     82   1.3      uch 	tx_chipset_tag_t sc_tc;
     83   1.3      uch 
     84   1.5      uch 	int sc_alarm;
     85   1.3      uch 	int sc_enabled;
     86   1.3      uch 	int sc_year;
     87  1.10      uch 	struct clock_ymdhms sc_epoch;
     88  1.21  gdamore 	struct timecounter sc_tcounter;
     89   1.1      uch };
     90   1.1      uch 
     91   1.6      uch int	tx39clock_match(struct device *, struct cfdata *, void *);
     92   1.6      uch void	tx39clock_attach(struct device *, struct device *, void *);
     93  1.11      uch #ifdef TX39CLOCK_DEBUG
     94   1.6      uch void	tx39clock_dump(tx_chipset_tag_t);
     95  1.11      uch #endif
     96   1.6      uch 
     97   1.6      uch void	tx39clock_cpuspeed(int *, int *);
     98   1.6      uch 
     99   1.6      uch void	__tx39timer_rtcfreeze(tx_chipset_tag_t);
    100   1.6      uch void	__tx39timer_rtcreset(tx_chipset_tag_t);
    101  1.19    perry inline void	__tx39timer_rtcget(struct txtime *);
    102  1.19    perry inline time_t __tx39timer_rtc2sec(struct txtime *);
    103  1.21  gdamore uint32_t tx39_timecount(struct timecounter *);
    104   1.1      uch 
    105  1.13  thorpej CFATTACH_DECL(tx39clock, sizeof(struct tx39clock_softc),
    106  1.13  thorpej     tx39clock_match, tx39clock_attach, NULL, NULL);
    107   1.1      uch 
    108   1.1      uch int
    109   1.6      uch tx39clock_match(struct device *parent, struct cfdata *cf, void *aux)
    110   1.1      uch {
    111  1.10      uch 
    112   1.9      uch 	return (ATTACH_FIRST);
    113   1.1      uch }
    114   1.1      uch 
    115   1.1      uch void
    116   1.6      uch tx39clock_attach(struct device *parent, struct device *self, void *aux)
    117   1.1      uch {
    118   1.1      uch 	struct txsim_attach_args *ta = aux;
    119   1.1      uch 	struct tx39clock_softc *sc = (void*)self;
    120   1.1      uch 	tx_chipset_tag_t tc;
    121   1.1      uch 	txreg_t reg;
    122   1.1      uch 
    123   1.1      uch 	tc = sc->sc_tc = ta->ta_tc;
    124   1.5      uch 	tx_conf_register_clock(tc, self);
    125   1.1      uch 
    126   1.3      uch 	/* Reset timer module */
    127   1.3      uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, 0);
    128   1.3      uch 
    129   1.3      uch 	/* Enable periodic timer */
    130   1.1      uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    131   1.1      uch 	reg |= TX39_TIMERCONTROL_ENPERTIMER;
    132   1.1      uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    133   1.3      uch 
    134   1.3      uch 	sc->sc_enabled = 0;
    135   1.3      uch 	/*
    136   1.3      uch 	 * RTC and ALARM
    137   1.3      uch 	 *    RTCINT    ... INTR5 bit 31  (roll over)
    138   1.3      uch 	 *    ALARMINT  ... INTR5 bit 30
    139   1.3      uch 	 *    PERINT    ... INTR5 bit 29
    140   1.3      uch 	 */
    141   1.3      uch 
    142  1.10      uch 	platform_clock_attach(self, &tx39_clock);
    143   1.1      uch 
    144  1.11      uch #ifdef TX39CLOCK_DEBUG
    145   1.1      uch 	tx39clock_dump(tc);
    146  1.11      uch #endif /* TX39CLOCK_DEBUG */
    147   1.1      uch }
    148   1.1      uch 
    149   1.3      uch /*
    150   1.3      uch  * cpuclock ... CPU clock (Hz)
    151   1.3      uch  * cpuspeed ... instructions-per-microsecond
    152   1.1      uch  */
    153   1.1      uch void
    154  1.17       he tx39clock_cpuspeed(int *cpuclock, int *cpu_speed)
    155   1.3      uch {
    156   1.3      uch 	struct txtime t0, t1;
    157   1.3      uch 	int elapsed;
    158   1.3      uch 
    159   1.3      uch 	__tx39timer_rtcget(&t0);
    160  1.19    perry 	__asm volatile(
    161  1.15   simonb 		".set	noreorder;		\n\t"
    162  1.15   simonb 		"li	$8, 10000000;		\n"
    163  1.15   simonb 	"1:	nop;				\n\t"
    164  1.15   simonb 		"nop;				\n\t"
    165  1.15   simonb 		"nop;				\n\t"
    166  1.15   simonb 		"nop;				\n\t"
    167  1.15   simonb 		"nop;				\n\t"
    168  1.15   simonb 		"nop;				\n\t"
    169  1.15   simonb 		"nop;				\n\t"
    170  1.15   simonb 		"add	$8, $8, -1;		\n\t"
    171  1.15   simonb 		"bnez	$8, 1b;			\n\t"
    172  1.15   simonb 		"nop;				\n\t"
    173  1.15   simonb 		".set	reorder;");
    174   1.3      uch 	__tx39timer_rtcget(&t1);
    175   1.3      uch 
    176   1.3      uch 	elapsed = t1.t_lo - t0.t_lo;
    177   1.3      uch 
    178   1.3      uch 	*cpuclock = (100000000 / elapsed) * TX39_RTCLOCK;
    179  1.17       he 	*cpu_speed = *cpuclock / 1000000;
    180   1.3      uch }
    181   1.3      uch 
    182   1.3      uch void
    183   1.6      uch __tx39timer_rtcfreeze(tx_chipset_tag_t tc)
    184   1.1      uch {
    185   1.1      uch 	txreg_t reg;
    186   1.1      uch 
    187   1.1      uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    188   1.3      uch 
    189   1.1      uch 	/* Freeze RTC */
    190   1.1      uch 	reg |= TX39_TIMERCONTROL_FREEZEPRE; /* Upper 8bit */
    191   1.1      uch 	reg |= TX39_TIMERCONTROL_FREEZERTC; /* Lower 32bit */
    192   1.3      uch 
    193   1.1      uch 	/* Freeze periodic timer */
    194   1.1      uch 	reg |= TX39_TIMERCONTROL_FREEZETIMER;
    195   1.1      uch 	reg &= ~TX39_TIMERCONTROL_ENPERTIMER;
    196   1.1      uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    197   1.1      uch }
    198   1.1      uch 
    199  1.19    perry inline void
    200   1.6      uch __tx39timer_rtcget(struct txtime *t)
    201   1.3      uch {
    202   1.3      uch 	tx_chipset_tag_t tc;
    203   1.3      uch 	txreg_t reghi, reglo, oreghi, oreglo;
    204   1.3      uch 	int retry;
    205   1.3      uch 
    206   1.3      uch 	tc = tx_conf_get_tag();
    207   1.3      uch 
    208   1.3      uch 	retry = 10;
    209   1.3      uch 
    210   1.3      uch 	do {
    211   1.3      uch 		oreglo = tx_conf_read(tc, TX39_TIMERRTCLO_REG);
    212   1.3      uch 		reglo = tx_conf_read(tc, TX39_TIMERRTCLO_REG);
    213   1.3      uch 
    214   1.3      uch 		oreghi = tx_conf_read(tc, TX39_TIMERRTCHI_REG);
    215   1.3      uch 		reghi = tx_conf_read(tc, TX39_TIMERRTCHI_REG);
    216   1.3      uch 	} while ((reghi != oreghi || reglo != oreglo) && (--retry > 0));
    217   1.3      uch 
    218   1.3      uch 	if (retry < 0) {
    219   1.3      uch 		printf("RTC timer read error.\n");
    220   1.3      uch 	}
    221   1.3      uch 
    222   1.3      uch 	t->t_hi = TX39_TIMERRTCHI(reghi);
    223   1.3      uch 	t->t_lo = reglo;
    224   1.3      uch }
    225   1.3      uch 
    226   1.1      uch void
    227   1.6      uch __tx39timer_rtcreset(tx_chipset_tag_t tc)
    228   1.1      uch {
    229   1.1      uch 	txreg_t reg;
    230   1.1      uch 
    231   1.1      uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    232   1.3      uch 
    233   1.1      uch 	/* Reset counter and stop */
    234   1.1      uch 	reg |= TX39_TIMERCONTROL_RTCCLR;
    235   1.1      uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    236   1.3      uch 
    237   1.1      uch 	/* Count again */
    238   1.1      uch 	reg &= ~TX39_TIMERCONTROL_RTCCLR;
    239   1.1      uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    240   1.1      uch }
    241   1.1      uch 
    242  1.21  gdamore uint32_t
    243  1.21  gdamore tx39_timecount(struct timecounter *tch)
    244  1.21  gdamore {
    245  1.21  gdamore 	tx_chipset_tag_t tc = tch->tc_priv;
    246  1.21  gdamore 
    247  1.21  gdamore 	/*
    248  1.21  gdamore 	 * since we're only reading the low register, we don't care about
    249  1.21  gdamore 	 * if the chip increments it.  we assume that the single read will
    250  1.21  gdamore 	 * always be consistent.  This is much faster than the routine which
    251  1.21  gdamore 	 * has to get both values, improving the quality.
    252  1.21  gdamore 	 */
    253  1.21  gdamore 	return (tx_conf_read(tc, TX39_TIMERRTCLO_REG));
    254  1.21  gdamore }
    255  1.21  gdamore 
    256   1.1      uch void
    257   1.6      uch tx39clock_init(struct device *dev)
    258   1.1      uch {
    259   1.5      uch 	struct tx39clock_softc *sc = (void*)dev;
    260   1.5      uch 	tx_chipset_tag_t tc = sc->sc_tc;
    261   1.1      uch 	txreg_t reg;
    262   1.3      uch 	int pcnt;
    263   1.1      uch 
    264   1.3      uch 	/*
    265   1.3      uch 	 * Setup periodic timer (interrupting hz times per second.)
    266   1.3      uch 	 */
    267  1.10      uch 	pcnt = TX39_TIMERCLK / CLOCK_RATE - 1;
    268   1.3      uch 	reg = tx_conf_read(tc, TX39_TIMERPERIODIC_REG);
    269   1.3      uch 	TX39_TIMERPERIODIC_PERVAL_CLR(reg);
    270   1.3      uch 	reg = TX39_TIMERPERIODIC_PERVAL_SET(reg, pcnt);
    271   1.3      uch 	tx_conf_write(tc, TX39_TIMERPERIODIC_REG, reg);
    272   1.3      uch 
    273   1.3      uch 	/*
    274   1.3      uch 	 * Enable periodic timer
    275   1.3      uch 	 */
    276   1.1      uch 	reg = tx_conf_read(tc, TX39_INTRENABLE6_REG);
    277   1.1      uch 	reg |= TX39_INTRPRI13_TIMER_PERIODIC_BIT;
    278   1.1      uch 	tx_conf_write(tc, TX39_INTRENABLE6_REG, reg);
    279   1.1      uch 
    280  1.21  gdamore 	sc->sc_tcounter.tc_name = "tx39rtc";
    281  1.21  gdamore 	sc->sc_tcounter.tc_get_timecount = tx39_timecount;
    282  1.21  gdamore 	sc->sc_tcounter.tc_priv = tc;
    283  1.21  gdamore 	sc->sc_tcounter.tc_counter_mask = 0xffffffff;
    284  1.21  gdamore 	sc->sc_tcounter.tc_frequency = TX39_RTCLOCK;
    285  1.21  gdamore 	sc->sc_tcounter.tc_quality = 100;
    286  1.21  gdamore 	tc_init(&sc->sc_tcounter);
    287   1.5      uch }
    288   1.5      uch 
    289   1.5      uch int
    290   1.6      uch tx39clock_alarm_set(tx_chipset_tag_t tc, int msec)
    291   1.5      uch {
    292   1.5      uch 	struct tx39clock_softc *sc = tc->tc_clockt;
    293   1.5      uch 
    294   1.5      uch 	sc->sc_alarm = TX39_MSEC2RTC(msec);
    295   1.5      uch 	tx39clock_alarm_refill(tc);
    296   1.5      uch 
    297   1.9      uch 	return (0);
    298   1.5      uch }
    299   1.5      uch 
    300   1.5      uch void
    301   1.6      uch tx39clock_alarm_refill(tx_chipset_tag_t tc)
    302   1.5      uch {
    303   1.5      uch 	struct tx39clock_softc *sc = tc->tc_clockt;
    304   1.5      uch 	struct txtime t;
    305  1.20  gdamore 	u_int64_t mytime;
    306   1.5      uch 
    307   1.5      uch 	__tx39timer_rtcget(&t);
    308   1.5      uch 
    309  1.20  gdamore 	mytime = ((u_int64_t)t.t_hi << 32) | (u_int64_t)t.t_lo;
    310  1.20  gdamore 	mytime += (u_int64_t)sc->sc_alarm;
    311   1.6      uch 
    312  1.20  gdamore 	t.t_hi = (u_int32_t)((mytime >> 32) & TX39_TIMERALARMHI_MASK);
    313  1.20  gdamore 	t.t_lo = (u_int32_t)(mytime & 0xffffffff);
    314   1.5      uch 
    315   1.6      uch 	tx_conf_write(tc, TX39_TIMERALARMHI_REG, t.t_hi);
    316   1.6      uch 	tx_conf_write(tc, TX39_TIMERALARMLO_REG, t.t_lo);
    317   1.1      uch }
    318   1.1      uch 
    319  1.11      uch #ifdef TX39CLOCK_DEBUG
    320   1.1      uch void
    321   1.6      uch tx39clock_dump(tx_chipset_tag_t tc)
    322   1.1      uch {
    323   1.1      uch 	txreg_t reg;
    324   1.1      uch 
    325   1.1      uch 	reg = tx_conf_read(tc, TX39_CLOCKCTRL_REG);
    326   1.3      uch 
    327   1.1      uch 	printf(" ");
    328   1.1      uch 	ISSETPRINT(reg, CHIM);
    329   1.1      uch #ifdef TX391X
    330   1.1      uch 	ISSETPRINT(reg, VID);
    331   1.1      uch 	ISSETPRINT(reg, MBUS);
    332   1.1      uch #endif /* TX391X */
    333   1.1      uch #ifdef TX392X
    334   1.1      uch 	ISSETPRINT(reg, IRDA);
    335   1.1      uch #endif /* TX392X */
    336   1.1      uch 	ISSETPRINT(reg, SPI);
    337   1.1      uch 	ISSETPRINT(reg, TIMER);
    338   1.1      uch 	ISSETPRINT(reg, FASTTIMER);
    339   1.1      uch #ifdef TX392X
    340   1.1      uch 	ISSETPRINT(reg, C48MOUT);
    341   1.1      uch #endif /* TX392X */
    342   1.1      uch 	ISSETPRINT(reg, SIBM);
    343   1.1      uch 	ISSETPRINT(reg, CSER);
    344   1.1      uch 	ISSETPRINT(reg, IR);
    345   1.1      uch 	ISSETPRINT(reg, UARTA);
    346   1.1      uch 	ISSETPRINT(reg, UARTB);
    347   1.1      uch 	printf("\n");
    348   1.1      uch }
    349  1.11      uch #endif /* TX39CLOCK_DEBUG */
    350