Home | History | Annotate | Line # | Download | only in mvme
clock_pcctwo.c revision 1.17
      1  1.17      chs /*	$NetBSD: clock_pcctwo.c,v 1.17 2012/10/27 17:18:27 chs Exp $	*/
      2   1.1      scw 
      3   1.1      scw /*-
      4   1.1      scw  * Copyright (c) 1999, 2002 The NetBSD Foundation, Inc.
      5   1.1      scw  * All rights reserved.
      6   1.1      scw  *
      7   1.1      scw  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1      scw  * by Steve C. Woodford.
      9   1.1      scw  *
     10   1.1      scw  * Redistribution and use in source and binary forms, with or without
     11   1.1      scw  * modification, are permitted provided that the following conditions
     12   1.1      scw  * are met:
     13   1.1      scw  * 1. Redistributions of source code must retain the above copyright
     14   1.1      scw  *    notice, this list of conditions and the following disclaimer.
     15   1.1      scw  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1      scw  *    notice, this list of conditions and the following disclaimer in the
     17   1.1      scw  *    documentation and/or other materials provided with the distribution.
     18   1.1      scw  *
     19   1.1      scw  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1      scw  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1      scw  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1      scw  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1      scw  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1      scw  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1      scw  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1      scw  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1      scw  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1      scw  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1      scw  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1      scw  */
     31   1.1      scw 
     32   1.1      scw /*
     33   1.1      scw  * Glue for the Peripheral Channel Controller Two (PCCChip2) timers,
     34   1.1      scw  * the Memory Controller ASIC (MCchip, and the Mostek clock chip found
     35   1.1      scw  * on the MVME-1[67]7, MVME-1[67]2 and MVME-187 series of boards.
     36   1.1      scw  */
     37   1.5    lukem 
     38   1.5    lukem #include <sys/cdefs.h>
     39  1.17      chs __KERNEL_RCSID(0, "$NetBSD: clock_pcctwo.c,v 1.17 2012/10/27 17:18:27 chs Exp $");
     40   1.1      scw 
     41   1.1      scw #include <sys/param.h>
     42   1.1      scw #include <sys/kernel.h>
     43   1.1      scw #include <sys/systm.h>
     44   1.1      scw #include <sys/device.h>
     45  1.12  tsutsui #include <sys/timetc.h>
     46   1.1      scw 
     47   1.1      scw #include <machine/psl.h>
     48  1.11       ad #include <sys/bus.h>
     49   1.1      scw 
     50   1.1      scw #include <dev/mvme/clockvar.h>
     51   1.1      scw #include <dev/mvme/pcctwovar.h>
     52   1.1      scw #include <dev/mvme/pcctworeg.h>
     53   1.1      scw 
     54   1.1      scw 
     55  1.16   cegger int clock_pcctwo_match(device_t, cfdata_t, void *);
     56  1.16   cegger void clock_pcctwo_attach(device_t, device_t, void *);
     57   1.1      scw 
     58   1.1      scw struct clock_pcctwo_softc {
     59   1.1      scw 	struct clock_attach_args sc_clock_args;
     60   1.1      scw 	u_char sc_clock_lvl;
     61  1.12  tsutsui 	struct timecounter sc_tc;
     62   1.1      scw };
     63   1.1      scw 
     64  1.17      chs CFATTACH_DECL_NEW(clock_pcctwo, sizeof(struct clock_pcctwo_softc),
     65   1.4  thorpej     clock_pcctwo_match, clock_pcctwo_attach, NULL, NULL);
     66   1.1      scw 
     67   1.1      scw extern struct cfdriver clock_cd;
     68   1.1      scw 
     69   1.6    perry static int clock_pcctwo_profintr(void *);
     70   1.6    perry static int clock_pcctwo_statintr(void *);
     71   1.6    perry static void clock_pcctwo_initclocks(void *, int, int);
     72  1.12  tsutsui static u_int clock_pcctwo_getcount(struct timecounter *);
     73   1.6    perry static void clock_pcctwo_shutdown(void *);
     74   1.1      scw 
     75   1.1      scw static struct clock_pcctwo_softc *clock_pcctwo_sc;
     76  1.12  tsutsui static uint32_t clock_pcctwo_count;
     77   1.1      scw 
     78   1.1      scw /* ARGSUSED */
     79   1.1      scw int
     80  1.16   cegger clock_pcctwo_match(device_t parent, cfdata_t cf, void *aux)
     81   1.1      scw {
     82   1.1      scw 	struct pcctwo_attach_args *pa = aux;
     83   1.1      scw 
     84   1.1      scw 	/* Only one clock, please. */
     85   1.1      scw 	if (clock_pcctwo_sc)
     86   1.1      scw 		return (0);
     87   1.1      scw 
     88   1.1      scw 	if (strcmp(pa->pa_name, clock_cd.cd_name))
     89   1.1      scw 		return (0);
     90   1.1      scw 
     91   1.1      scw 	pa->pa_ipl = cf->pcctwocf_ipl;
     92   1.1      scw 
     93   1.1      scw 	return (1);
     94   1.1      scw }
     95   1.1      scw 
     96   1.1      scw /* ARGSUSED */
     97   1.1      scw void
     98  1.16   cegger clock_pcctwo_attach(device_t parent, device_t self, void *aux)
     99   1.1      scw {
    100   1.1      scw 	struct clock_pcctwo_softc *sc;
    101   1.1      scw 	struct pcctwo_attach_args *pa;
    102   1.1      scw 
    103  1.10  thorpej 	sc = clock_pcctwo_sc = device_private(self);
    104   1.1      scw 	pa = aux;
    105   1.1      scw 
    106   1.1      scw 	if (pa->pa_ipl != CLOCK_LEVEL)
    107   1.1      scw 		panic("clock_pcctwo_attach: wrong interrupt level");
    108   1.1      scw 
    109   1.1      scw 	sc->sc_clock_args.ca_arg = sc;
    110   1.1      scw 	sc->sc_clock_args.ca_initfunc = clock_pcctwo_initclocks;
    111   1.1      scw 
    112   1.1      scw 	/* Do common portions of clock config. */
    113   1.1      scw 	clock_config(self, &sc->sc_clock_args, pcctwointr_evcnt(pa->pa_ipl));
    114   1.1      scw 
    115   1.1      scw 	/* Ensure our interrupts get disabled at shutdown time. */
    116   1.1      scw 	(void) shutdownhook_establish(clock_pcctwo_shutdown, NULL);
    117   1.1      scw 
    118   1.1      scw 	sc->sc_clock_lvl = (pa->pa_ipl & PCCTWO_ICR_LEVEL_MASK) |
    119   1.1      scw 	    PCCTWO_ICR_ICLR | PCCTWO_ICR_IEN;
    120   1.1      scw 
    121   1.1      scw 	/* Attach the interrupt handlers. */
    122   1.1      scw 	pcctwointr_establish(PCCTWOV_TIMER1, clock_pcctwo_profintr,
    123   1.1      scw 	    pa->pa_ipl, NULL, &clock_profcnt);
    124   1.1      scw 	pcctwointr_establish(PCCTWOV_TIMER2, clock_pcctwo_statintr,
    125   1.1      scw 	    pa->pa_ipl, NULL, &clock_statcnt);
    126   1.1      scw }
    127   1.1      scw 
    128   1.1      scw void
    129  1.14      dsl clock_pcctwo_initclocks(void *arg, int prof_us, int stat_us)
    130   1.1      scw {
    131   1.1      scw 	struct clock_pcctwo_softc *sc;
    132   1.1      scw 
    133   1.1      scw 	sc = arg;
    134   1.1      scw 
    135   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_CONTROL, PCCTWO_TT_CTRL_COVF);
    136   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER1_COUNTER, 0);
    137   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER1_COMPARE,
    138   1.8      scw 	    PCCTWO_US2LIM(prof_us));
    139   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_CONTROL,
    140   1.1      scw 	    PCCTWO_TT_CTRL_CEN | PCCTWO_TT_CTRL_COC | PCCTWO_TT_CTRL_COVF);
    141   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_ICSR, sc->sc_clock_lvl);
    142   1.1      scw 
    143   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_CONTROL, PCCTWO_TT_CTRL_COVF);
    144   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER2_COUNTER, 0);
    145   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER2_COMPARE,
    146   1.8      scw 	    PCCTWO_US2LIM(stat_us));
    147   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_CONTROL,
    148   1.1      scw 	    PCCTWO_TT_CTRL_CEN | PCCTWO_TT_CTRL_COC | PCCTWO_TT_CTRL_COVF);
    149   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_ICSR, sc->sc_clock_lvl);
    150  1.12  tsutsui 
    151  1.12  tsutsui 	sc->sc_tc.tc_get_timecount = clock_pcctwo_getcount;
    152  1.12  tsutsui 	sc->sc_tc.tc_name = "pcctwo_count";
    153  1.12  tsutsui 	sc->sc_tc.tc_frequency = PCCTWO_TIMERFREQ;
    154  1.12  tsutsui 	sc->sc_tc.tc_quality = 100;
    155  1.12  tsutsui 	sc->sc_tc.tc_counter_mask = ~0;
    156  1.12  tsutsui 	tc_init(&sc->sc_tc);
    157   1.1      scw }
    158   1.1      scw 
    159   1.1      scw /* ARGSUSED */
    160  1.12  tsutsui u_int
    161  1.12  tsutsui clock_pcctwo_getcount(struct timecounter *tc)
    162   1.1      scw {
    163  1.12  tsutsui 	u_int cnt;
    164  1.12  tsutsui 	uint32_t tc1, tc2;
    165  1.12  tsutsui 	uint8_t cr;
    166  1.12  tsutsui 	int s;
    167  1.12  tsutsui 
    168  1.12  tsutsui 	s = splhigh();
    169   1.1      scw 
    170   1.1      scw 	/*
    171   1.1      scw 	 * There's no way to latch the counter and overflow registers
    172   1.1      scw 	 * without pausing the clock, so compensate for the possible
    173   1.1      scw 	 * race by checking for counter wrap-around and re-reading the
    174   1.1      scw 	 * overflow counter if necessary.
    175   1.1      scw 	 *
    176  1.12  tsutsui 	 * Note: This only works because we're at splhigh().
    177   1.1      scw 	 */
    178  1.12  tsutsui 	tc1 = pcc2_reg_read32(sys_pcctwo, PCC2REG_TIMER1_COUNTER);
    179   1.1      scw 	cr = pcc2_reg_read(sys_pcctwo, PCC2REG_TIMER1_CONTROL);
    180  1.12  tsutsui 	tc2 = pcc2_reg_read32(sys_pcctwo, PCC2REG_TIMER1_COUNTER);
    181  1.12  tsutsui 	if (tc1 > tc2) {
    182   1.1      scw 		cr = pcc2_reg_read(sys_pcctwo, PCC2REG_TIMER1_CONTROL);
    183  1.12  tsutsui 		tc1 = tc2;
    184   1.1      scw 	}
    185  1.12  tsutsui 	cnt = clock_pcctwo_count;
    186  1.12  tsutsui 	splx(s);
    187  1.12  tsutsui 	/* XXX assume HZ == 100 */
    188  1.12  tsutsui 	cnt += tc1 + (PCCTWO_TIMERFREQ / 100) * PCCTWO_TT_CTRL_OVF(cr);
    189   1.1      scw 
    190  1.12  tsutsui 	return cnt;
    191   1.1      scw }
    192   1.1      scw 
    193   1.1      scw int
    194  1.14      dsl clock_pcctwo_profintr(void *frame)
    195   1.1      scw {
    196   1.1      scw 	u_int8_t cr;
    197   1.1      scw 	u_int32_t tc;
    198   1.1      scw 	int s;
    199   1.1      scw 
    200   1.1      scw 	s = splhigh();
    201   1.1      scw 	tc = pcc2_reg_read32(sys_pcctwo, PCC2REG_TIMER1_COUNTER);
    202   1.1      scw 	cr = pcc2_reg_read(sys_pcctwo, PCC2REG_TIMER1_CONTROL);
    203   1.1      scw 	if (tc > pcc2_reg_read32(sys_pcctwo, PCC2REG_TIMER1_COUNTER))
    204   1.1      scw 		cr = pcc2_reg_read(sys_pcctwo, PCC2REG_TIMER1_CONTROL);
    205   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_CONTROL,
    206   1.1      scw 	    PCCTWO_TT_CTRL_CEN | PCCTWO_TT_CTRL_COC | PCCTWO_TT_CTRL_COVF);
    207   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_ICSR,
    208   1.1      scw 	    clock_pcctwo_sc->sc_clock_lvl);
    209   1.1      scw 	splx(s);
    210   1.1      scw 
    211  1.12  tsutsui 	for (cr = PCCTWO_TT_CTRL_OVF(cr); cr; cr--) {
    212  1.12  tsutsui 		/* XXX assume HZ == 100 */
    213  1.12  tsutsui 		clock_pcctwo_count += PCCTWO_TIMERFREQ / 100;
    214   1.1      scw 		hardclock(frame);
    215  1.12  tsutsui 	}
    216   1.1      scw 
    217   1.1      scw 	return (1);
    218   1.1      scw }
    219   1.1      scw 
    220   1.1      scw int
    221  1.14      dsl clock_pcctwo_statintr(void *frame)
    222   1.1      scw {
    223   1.1      scw 
    224   1.1      scw 	/* Disable the timer interrupt while we handle it. */
    225   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_ICSR, 0);
    226   1.1      scw 
    227   1.1      scw 	statclock((struct clockframe *) frame);
    228   1.1      scw 
    229   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_CONTROL, PCCTWO_TT_CTRL_COVF);
    230   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER2_COUNTER, 0);
    231   1.1      scw 	pcc2_reg_write32(sys_pcctwo, PCC2REG_TIMER2_COMPARE,
    232   1.1      scw 	    PCCTWO_US2LIM(CLOCK_NEWINT(clock_statvar, clock_statmin)));
    233   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_CONTROL,
    234   1.1      scw 	    PCCTWO_TT_CTRL_CEN | PCCTWO_TT_CTRL_COC | PCCTWO_TT_CTRL_COVF);
    235   1.1      scw 
    236   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_ICSR,
    237   1.1      scw 	    clock_pcctwo_sc->sc_clock_lvl);
    238   1.1      scw 
    239   1.1      scw 	return (1);
    240   1.1      scw }
    241   1.1      scw 
    242   1.1      scw /* ARGSUSED */
    243   1.1      scw void
    244  1.14      dsl clock_pcctwo_shutdown(void *arg)
    245   1.1      scw {
    246   1.1      scw 
    247   1.1      scw 	/* Make sure the timer interrupts are turned off. */
    248   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_CONTROL, PCCTWO_TT_CTRL_COVF);
    249   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER1_ICSR, 0);
    250   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_CONTROL, PCCTWO_TT_CTRL_COVF);
    251   1.1      scw 	pcc2_reg_write(sys_pcctwo, PCC2REG_TIMER2_ICSR, 0);
    252   1.1      scw }
    253