tx39clock.c revision 1.11.10.1       1  1.11.10.1  jmc /*	$NetBSD: tx39clock.c,v 1.11.10.1 2004/03/12 06:10:55 jmc 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.6  uch 
     39       1.11  uch #include "opt_tx39clock_debug.h"
     40        1.1  uch 
     41        1.1  uch #include <sys/param.h>
     42        1.1  uch #include <sys/systm.h>
     43        1.1  uch 
     44        1.3  uch #include <dev/clock_subr.h>
     45        1.3  uch 
     46        1.1  uch #include <machine/bus.h>
     47       1.10  uch #include <machine/sysconf.h>
     48        1.1  uch 
     49        1.1  uch #include <hpcmips/tx/tx39var.h>
     50        1.3  uch #include <hpcmips/tx/tx39icureg.h>
     51        1.5  uch #include <hpcmips/tx/tx39clockvar.h>
     52        1.1  uch #include <hpcmips/tx/tx39clockreg.h>
     53        1.1  uch #include <hpcmips/tx/tx39timerreg.h>
     54        1.3  uch 
     55       1.11  uch #ifdef	TX39CLOCK_DEBUG
     56       1.11  uch #define DPRINTF_ENABLE
     57       1.11  uch #define DPRINTF_DEBUG	tx39clock_debug
     58        1.3  uch #endif
     59       1.11  uch #include <machine/debug.h>
     60        1.3  uch 
     61       1.11  uch #define ISSETPRINT(r, m)						\
     62       1.11  uch 	dbg_bitmask_print(r, TX39_CLOCK_EN ## m ## CLK, #m)
     63        1.1  uch 
     64        1.6  uch void	tx39clock_init(struct device *);
     65       1.10  uch void	tx39clock_get(struct device *, time_t, struct clock_ymdhms *);
     66       1.10  uch void	tx39clock_set(struct device *, struct clock_ymdhms *);
     67        1.3  uch 
     68       1.10  uch struct platform_clock tx39_clock = {
     69       1.10  uch #define CLOCK_RATE	100
     70       1.10  uch 	CLOCK_RATE, tx39clock_init, tx39clock_get, tx39clock_set,
     71        1.3  uch };
     72        1.1  uch 
     73        1.3  uch struct txtime {
     74        1.3  uch 	u_int32_t t_hi;
     75        1.3  uch 	u_int32_t t_lo;
     76        1.3  uch };
     77        1.3  uch 
     78        1.3  uch struct tx39clock_softc {
     79        1.3  uch 	struct	device sc_dev;
     80        1.3  uch 	tx_chipset_tag_t sc_tc;
     81        1.3  uch 
     82        1.5  uch 	int sc_alarm;
     83        1.3  uch 	int sc_enabled;
     84        1.3  uch 	int sc_year;
     85       1.10  uch 	struct clock_ymdhms sc_epoch;
     86        1.1  uch };
     87        1.1  uch 
     88        1.6  uch int	tx39clock_match(struct device *, struct cfdata *, void *);
     89        1.6  uch void	tx39clock_attach(struct device *, struct device *, void *);
     90       1.11  uch #ifdef TX39CLOCK_DEBUG
     91        1.6  uch void	tx39clock_dump(tx_chipset_tag_t);
     92       1.11  uch #endif
     93        1.6  uch 
     94        1.6  uch void	tx39clock_cpuspeed(int *, int *);
     95        1.6  uch 
     96        1.6  uch void	__tx39timer_rtcfreeze(tx_chipset_tag_t);
     97        1.6  uch void	__tx39timer_rtcreset(tx_chipset_tag_t);
     98        1.6  uch __inline__ void	__tx39timer_rtcget(struct txtime *);
     99        1.6  uch __inline__ time_t __tx39timer_rtc2sec(struct txtime *);
    100        1.1  uch 
    101        1.1  uch struct cfattach tx39clock_ca = {
    102        1.1  uch 	sizeof(struct tx39clock_softc), tx39clock_match, tx39clock_attach
    103        1.1  uch };
    104        1.1  uch 
    105        1.1  uch int
    106        1.6  uch tx39clock_match(struct device *parent, struct cfdata *cf, void *aux)
    107        1.1  uch {
    108       1.10  uch 
    109        1.9  uch 	return (ATTACH_FIRST);
    110        1.1  uch }
    111        1.1  uch 
    112        1.1  uch void
    113        1.6  uch tx39clock_attach(struct device *parent, struct device *self, void *aux)
    114        1.1  uch {
    115        1.1  uch 	struct txsim_attach_args *ta = aux;
    116        1.1  uch 	struct tx39clock_softc *sc = (void*)self;
    117        1.1  uch 	tx_chipset_tag_t tc;
    118        1.1  uch 	txreg_t reg;
    119        1.1  uch 
    120        1.1  uch 	tc = sc->sc_tc = ta->ta_tc;
    121        1.5  uch 	tx_conf_register_clock(tc, self);
    122        1.1  uch 
    123        1.3  uch 	/* Reset timer module */
    124        1.3  uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, 0);
    125        1.3  uch 
    126        1.3  uch 	/* Enable periodic timer */
    127        1.1  uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    128        1.1  uch 	reg |= TX39_TIMERCONTROL_ENPERTIMER;
    129        1.1  uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    130        1.3  uch 
    131        1.3  uch 	sc->sc_enabled = 0;
    132        1.3  uch 	/*
    133        1.3  uch 	 * RTC and ALARM
    134        1.3  uch 	 *    RTCINT    ... INTR5 bit 31  (roll over)
    135        1.3  uch 	 *    ALARMINT  ... INTR5 bit 30
    136        1.3  uch 	 *    PERINT    ... INTR5 bit 29
    137        1.3  uch 	 */
    138        1.3  uch 
    139       1.10  uch 	platform_clock_attach(self, &tx39_clock);
    140        1.1  uch 
    141       1.11  uch #ifdef TX39CLOCK_DEBUG
    142        1.1  uch 	tx39clock_dump(tc);
    143       1.11  uch #endif /* TX39CLOCK_DEBUG */
    144        1.1  uch }
    145        1.1  uch 
    146        1.3  uch /*
    147        1.3  uch  * cpuclock ... CPU clock (Hz)
    148        1.3  uch  * cpuspeed ... instructions-per-microsecond
    149        1.1  uch  */
    150        1.1  uch void
    151        1.6  uch tx39clock_cpuspeed(int *cpuclock, int *cpuspeed)
    152        1.3  uch {
    153        1.3  uch 	struct txtime t0, t1;
    154        1.3  uch 	int elapsed;
    155        1.3  uch 
    156        1.3  uch 	__tx39timer_rtcget(&t0);
    157        1.6  uch 	__asm__ __volatile__("
    158        1.3  uch 		.set	noreorder;
    159        1.3  uch 		li	$8, 10000000;
    160        1.3  uch 	1:	nop;
    161        1.3  uch 		nop;
    162        1.3  uch 		nop;
    163        1.3  uch 		nop;
    164        1.3  uch 		nop;
    165        1.3  uch 		nop;
    166        1.3  uch 		nop;
    167        1.3  uch 		add	$8, $8, -1;
    168        1.3  uch 		bnez	$8, 1b;
    169        1.3  uch 		nop;
    170        1.3  uch 		.set	reorder;
    171        1.3  uch 	");
    172        1.3  uch 	__tx39timer_rtcget(&t1);
    173        1.3  uch 
    174        1.3  uch 	elapsed = t1.t_lo - t0.t_lo;
    175        1.3  uch 
    176        1.3  uch 	*cpuclock = (100000000 / elapsed) * TX39_RTCLOCK;
    177        1.3  uch 	*cpuspeed = *cpuclock / 1000000;
    178        1.3  uch }
    179        1.3  uch 
    180        1.3  uch void
    181        1.6  uch __tx39timer_rtcfreeze(tx_chipset_tag_t tc)
    182        1.1  uch {
    183        1.1  uch 	txreg_t reg;
    184        1.1  uch 
    185        1.1  uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    186        1.3  uch 
    187        1.1  uch 	/* Freeze RTC */
    188        1.1  uch 	reg |= TX39_TIMERCONTROL_FREEZEPRE; /* Upper 8bit */
    189        1.1  uch 	reg |= TX39_TIMERCONTROL_FREEZERTC; /* Lower 32bit */
    190        1.3  uch 
    191        1.1  uch 	/* Freeze periodic timer */
    192        1.1  uch 	reg |= TX39_TIMERCONTROL_FREEZETIMER;
    193        1.1  uch 	reg &= ~TX39_TIMERCONTROL_ENPERTIMER;
    194        1.1  uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    195        1.1  uch }
    196        1.1  uch 
    197        1.6  uch __inline__ time_t
    198        1.6  uch __tx39timer_rtc2sec(struct txtime *t)
    199        1.3  uch {
    200        1.3  uch 	/* This rely on RTC is 32.768kHz */
    201        1.9  uch 	return ((t->t_lo >> 15) | (t->t_hi << 17));
    202        1.3  uch }
    203        1.3  uch 
    204        1.6  uch __inline__ void
    205        1.6  uch __tx39timer_rtcget(struct txtime *t)
    206        1.3  uch {
    207        1.3  uch 	tx_chipset_tag_t tc;
    208        1.3  uch 	txreg_t reghi, reglo, oreghi, oreglo;
    209        1.3  uch 	int retry;
    210        1.3  uch 
    211        1.3  uch 	tc = tx_conf_get_tag();
    212        1.3  uch 
    213        1.3  uch 	retry = 10;
    214        1.3  uch 
    215        1.3  uch 	do {
    216        1.3  uch 		oreglo = tx_conf_read(tc, TX39_TIMERRTCLO_REG);
    217        1.3  uch 		reglo = tx_conf_read(tc, TX39_TIMERRTCLO_REG);
    218        1.3  uch 
    219        1.3  uch 		oreghi = tx_conf_read(tc, TX39_TIMERRTCHI_REG);
    220        1.3  uch 		reghi = tx_conf_read(tc, TX39_TIMERRTCHI_REG);
    221        1.3  uch 	} while ((reghi != oreghi || reglo != oreglo) && (--retry > 0));
    222        1.3  uch 
    223        1.3  uch 	if (retry < 0) {
    224        1.3  uch 		printf("RTC timer read error.\n");
    225        1.3  uch 	}
    226        1.3  uch 
    227        1.3  uch 	t->t_hi = TX39_TIMERRTCHI(reghi);
    228        1.3  uch 	t->t_lo = reglo;
    229        1.3  uch }
    230        1.3  uch 
    231        1.1  uch void
    232        1.6  uch __tx39timer_rtcreset(tx_chipset_tag_t tc)
    233        1.1  uch {
    234        1.1  uch 	txreg_t reg;
    235        1.1  uch 
    236        1.1  uch 	reg = tx_conf_read(tc, TX39_TIMERCONTROL_REG);
    237        1.3  uch 
    238        1.1  uch 	/* Reset counter and stop */
    239        1.1  uch 	reg |= TX39_TIMERCONTROL_RTCCLR;
    240        1.1  uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    241        1.3  uch 
    242        1.1  uch 	/* Count again */
    243        1.1  uch 	reg &= ~TX39_TIMERCONTROL_RTCCLR;
    244        1.1  uch 	tx_conf_write(tc, TX39_TIMERCONTROL_REG, reg);
    245        1.1  uch }
    246        1.1  uch 
    247        1.1  uch void
    248        1.6  uch tx39clock_init(struct device *dev)
    249        1.1  uch {
    250        1.5  uch 	struct tx39clock_softc *sc = (void*)dev;
    251        1.5  uch 	tx_chipset_tag_t tc = sc->sc_tc;
    252        1.1  uch 	txreg_t reg;
    253        1.3  uch 	int pcnt;
    254        1.1  uch 
    255        1.3  uch 	/*
    256        1.3  uch 	 * Setup periodic timer (interrupting hz times per second.)
    257        1.3  uch 	 */
    258       1.10  uch 	pcnt = TX39_TIMERCLK / CLOCK_RATE - 1;
    259        1.3  uch 	reg = tx_conf_read(tc, TX39_TIMERPERIODIC_REG);
    260        1.3  uch 	TX39_TIMERPERIODIC_PERVAL_CLR(reg);
    261        1.3  uch 	reg = TX39_TIMERPERIODIC_PERVAL_SET(reg, pcnt);
    262        1.3  uch 	tx_conf_write(tc, TX39_TIMERPERIODIC_REG, reg);
    263        1.3  uch 
    264        1.3  uch 	/*
    265        1.3  uch 	 * Enable periodic timer
    266        1.3  uch 	 */
    267        1.1  uch 	reg = tx_conf_read(tc, TX39_INTRENABLE6_REG);
    268        1.1  uch 	reg |= TX39_INTRPRI13_TIMER_PERIODIC_BIT;
    269        1.1  uch 	tx_conf_write(tc, TX39_INTRENABLE6_REG, reg);
    270        1.1  uch }
    271        1.1  uch 
    272        1.1  uch void
    273       1.10  uch tx39clock_get(struct device *dev, time_t base, struct clock_ymdhms *t)
    274        1.1  uch {
    275       1.10  uch 	struct tx39clock_softc *sc = (void *)dev;
    276        1.3  uch 	struct clock_ymdhms dt;
    277        1.3  uch 	struct txtime tt;
    278        1.3  uch 	time_t sec;
    279        1.3  uch 
    280        1.3  uch 	__tx39timer_rtcget(&tt);
    281        1.3  uch 	sec = __tx39timer_rtc2sec(&tt);
    282        1.3  uch 
    283        1.3  uch 	if (!sc->sc_enabled) {
    284        1.3  uch 		DPRINTF(("bootstrap: %d sec from previous reboot\n",
    285        1.9  uch 		    (int)sec));
    286        1.3  uch 
    287        1.3  uch 		sc->sc_enabled = 1;
    288  1.11.10.1  jmc 		clock_secs_to_ymdhms(base, &dt);
    289  1.11.10.1  jmc 		sc->sc_epoch = dt;
    290        1.3  uch 		base += sec;
    291        1.3  uch 	} else {
    292        1.3  uch 		dt.dt_year = sc->sc_year;
    293       1.10  uch 		dt.dt_mon = sc->sc_epoch.dt_mon;
    294       1.10  uch 		dt.dt_day = sc->sc_epoch.dt_day;
    295       1.10  uch 		dt.dt_hour = sc->sc_epoch.dt_hour;
    296       1.10  uch 		dt.dt_min = sc->sc_epoch.dt_min;
    297       1.10  uch 		dt.dt_sec = sc->sc_epoch.dt_sec;
    298       1.10  uch 		dt.dt_wday = sc->sc_epoch.dt_wday;
    299        1.4  uch 		base = sec + clock_ymdhms_to_secs(&dt);
    300        1.3  uch 	}
    301        1.3  uch 
    302        1.3  uch 	clock_secs_to_ymdhms(base, &dt);
    303       1.10  uch 
    304       1.10  uch 	t->dt_year = dt.dt_year % 100;
    305       1.10  uch 	t->dt_mon = dt.dt_mon;
    306       1.10  uch 	t->dt_day = dt.dt_day;
    307       1.10  uch 	t->dt_hour = dt.dt_hour;
    308       1.10  uch 	t->dt_min = dt.dt_min;
    309       1.10  uch 	t->dt_sec = dt.dt_sec;
    310       1.10  uch 	t->dt_wday = dt.dt_wday;
    311        1.1  uch 
    312        1.3  uch 	sc->sc_year = dt.dt_year;
    313        1.1  uch }
    314        1.1  uch 
    315        1.1  uch void
    316       1.10  uch tx39clock_set(struct device *dev, struct clock_ymdhms *dt)
    317        1.1  uch {
    318       1.10  uch 	struct tx39clock_softc *sc = (void *)dev;
    319        1.3  uch 
    320        1.3  uch 	if (sc->sc_enabled) {
    321       1.10  uch 		sc->sc_epoch = *dt;
    322  1.11.10.1  jmc 		__tx39timer_rtcreset(sc->sc_tc);
    323  1.11.10.1  jmc 		tx39clock_alarm_refill(sc->sc_tc);
    324        1.3  uch 	}
    325        1.5  uch }
    326        1.5  uch 
    327        1.5  uch int
    328        1.6  uch tx39clock_alarm_set(tx_chipset_tag_t tc, int msec)
    329        1.5  uch {
    330        1.5  uch 	struct tx39clock_softc *sc = tc->tc_clockt;
    331        1.5  uch 
    332        1.5  uch 	sc->sc_alarm = TX39_MSEC2RTC(msec);
    333        1.5  uch 	tx39clock_alarm_refill(tc);
    334        1.5  uch 
    335        1.9  uch 	return (0);
    336        1.5  uch }
    337        1.5  uch 
    338        1.5  uch void
    339        1.6  uch tx39clock_alarm_refill(tx_chipset_tag_t tc)
    340        1.5  uch {
    341        1.5  uch 	struct tx39clock_softc *sc = tc->tc_clockt;
    342        1.5  uch 	struct txtime t;
    343        1.6  uch 	u_int64_t time;
    344        1.5  uch 
    345        1.5  uch 	__tx39timer_rtcget(&t);
    346        1.5  uch 
    347        1.6  uch 	time = ((u_int64_t)t.t_hi << 32) | (u_int64_t)t.t_lo;
    348        1.6  uch 	time += (u_int64_t)sc->sc_alarm;
    349        1.6  uch 
    350        1.6  uch 	t.t_hi = (u_int32_t)((time >> 32) & TX39_TIMERALARMHI_MASK);
    351        1.6  uch 	t.t_lo = (u_int32_t)(time & 0xffffffff);
    352        1.5  uch 
    353        1.6  uch 	tx_conf_write(tc, TX39_TIMERALARMHI_REG, t.t_hi);
    354        1.6  uch 	tx_conf_write(tc, TX39_TIMERALARMLO_REG, t.t_lo);
    355        1.1  uch }
    356        1.1  uch 
    357       1.11  uch #ifdef TX39CLOCK_DEBUG
    358        1.1  uch void
    359        1.6  uch tx39clock_dump(tx_chipset_tag_t tc)
    360        1.1  uch {
    361        1.1  uch 	txreg_t reg;
    362        1.1  uch 
    363        1.1  uch 	reg = tx_conf_read(tc, TX39_CLOCKCTRL_REG);
    364        1.3  uch 
    365        1.1  uch 	printf(" ");
    366        1.1  uch 	ISSETPRINT(reg, CHIM);
    367        1.1  uch #ifdef TX391X
    368        1.1  uch 	ISSETPRINT(reg, VID);
    369        1.1  uch 	ISSETPRINT(reg, MBUS);
    370        1.1  uch #endif /* TX391X */
    371        1.1  uch #ifdef TX392X
    372        1.1  uch 	ISSETPRINT(reg, IRDA);
    373        1.1  uch #endif /* TX392X */
    374        1.1  uch 	ISSETPRINT(reg, SPI);
    375        1.1  uch 	ISSETPRINT(reg, TIMER);
    376        1.1  uch 	ISSETPRINT(reg, FASTTIMER);
    377        1.1  uch #ifdef TX392X
    378        1.1  uch 	ISSETPRINT(reg, C48MOUT);
    379        1.1  uch #endif /* TX392X */
    380        1.1  uch 	ISSETPRINT(reg, SIBM);
    381        1.1  uch 	ISSETPRINT(reg, CSER);
    382        1.1  uch 	ISSETPRINT(reg, IR);
    383        1.1  uch 	ISSETPRINT(reg, UARTA);
    384        1.1  uch 	ISSETPRINT(reg, UARTB);
    385        1.1  uch 	printf("\n");
    386        1.1  uch }
    387       1.11  uch #endif /* TX39CLOCK_DEBUG */
    388