Home | History | Annotate | Line # | Download | only in dev
clock.c revision 1.10
      1  1.10  jmcneill /* $NetBSD: clock.c,v 1.10 2011/08/23 16:09:27 jmcneill Exp $ */
      2   1.1  jmcneill 
      3   1.1  jmcneill /*-
      4   1.1  jmcneill  * Copyright (c) 2007 Jared D. McNeill <jmcneill (at) invisible.ca>
      5   1.1  jmcneill  * All rights reserved.
      6   1.1  jmcneill  *
      7   1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8   1.1  jmcneill  * modification, are permitted provided that the following conditions
      9   1.1  jmcneill  * are met:
     10   1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12   1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15   1.1  jmcneill  *
     16   1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17   1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18   1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19   1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20   1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21   1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22   1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23   1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24   1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25   1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26   1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     27   1.1  jmcneill  */
     28   1.1  jmcneill 
     29   1.1  jmcneill #include <sys/cdefs.h>
     30  1.10  jmcneill __KERNEL_RCSID(0, "$NetBSD: clock.c,v 1.10 2011/08/23 16:09:27 jmcneill Exp $");
     31   1.1  jmcneill 
     32   1.1  jmcneill #include <sys/param.h>
     33   1.1  jmcneill #include <sys/proc.h>
     34   1.1  jmcneill #include <sys/systm.h>
     35   1.1  jmcneill #include <sys/device.h>
     36   1.2     joerg #include <sys/timetc.h>
     37   1.5  jmcneill #include <sys/time.h>
     38   1.1  jmcneill 
     39   1.1  jmcneill #include <machine/mainbus.h>
     40   1.6  jmcneill #include <machine/thunk.h>
     41   1.1  jmcneill 
     42   1.8  jmcneill #include <dev/clock_subr.h>
     43   1.8  jmcneill 
     44   1.1  jmcneill static int	clock_match(device_t, cfdata_t, void *);
     45   1.1  jmcneill static void	clock_attach(device_t, device_t, void *);
     46   1.1  jmcneill 
     47   1.1  jmcneill static void 	clock_intr(int);
     48  1.10  jmcneill static unsigned int clock_getcounter(struct timecounter *);
     49   1.1  jmcneill 
     50   1.8  jmcneill static int	clock_todr_gettime(struct todr_chip_handle *, struct timeval *);
     51   1.8  jmcneill 
     52   1.1  jmcneill typedef struct clock_softc {
     53   1.8  jmcneill 	device_t		sc_dev;
     54   1.8  jmcneill 	struct todr_chip_handle	sc_todr;
     55   1.1  jmcneill } clock_softc_t;
     56   1.1  jmcneill 
     57   1.2     joerg static struct timecounter clock_timecounter = {
     58   1.2     joerg 	clock_getcounter,	/* get_timecount */
     59   1.2     joerg 	0,			/* no poll_pps */
     60   1.2     joerg 	~0u,			/* counter_mask */
     61   1.8  jmcneill 	0,			/* frequency */
     62   1.8  jmcneill 	"CLOCK_MONOTONIC",	/* name */
     63   1.8  jmcneill 	-100,			/* quality */
     64   1.2     joerg 	NULL,			/* prev */
     65   1.2     joerg 	NULL,			/* next */
     66   1.2     joerg };
     67   1.2     joerg 
     68   1.1  jmcneill CFATTACH_DECL_NEW(clock, sizeof(clock_softc_t),
     69   1.1  jmcneill     clock_match, clock_attach, NULL, NULL);
     70   1.1  jmcneill 
     71   1.1  jmcneill static int
     72   1.1  jmcneill clock_match(device_t parent, cfdata_t match, void *opaque)
     73   1.1  jmcneill {
     74   1.1  jmcneill 	struct thunkbus_attach_args *taa = opaque;
     75   1.1  jmcneill 
     76   1.1  jmcneill 	if (taa->taa_type != THUNKBUS_TYPE_CLOCK)
     77   1.1  jmcneill 		return 0;
     78   1.1  jmcneill 
     79   1.1  jmcneill 	return 1;
     80   1.1  jmcneill }
     81   1.1  jmcneill 
     82   1.1  jmcneill static void
     83   1.1  jmcneill clock_attach(device_t parent, device_t self, void *opaque)
     84   1.1  jmcneill {
     85   1.1  jmcneill 	clock_softc_t *sc = device_private(self);
     86   1.1  jmcneill 	struct itimerval itimer;
     87   1.9  jmcneill 	long tcres;
     88   1.1  jmcneill 
     89   1.1  jmcneill 	aprint_naive("\n");
     90   1.1  jmcneill 	aprint_normal("\n");
     91   1.1  jmcneill 
     92   1.1  jmcneill 	sc->sc_dev = self;
     93   1.1  jmcneill 
     94   1.8  jmcneill 	sc->sc_todr.todr_gettime = clock_todr_gettime;
     95   1.8  jmcneill 	todr_attach(&sc->sc_todr);
     96   1.8  jmcneill 
     97   1.1  jmcneill 	(void)signal(SIGALRM, clock_intr);
     98   1.1  jmcneill 
     99   1.1  jmcneill 	itimer.it_interval.tv_sec = 0;
    100   1.1  jmcneill 	itimer.it_interval.tv_usec = 10000;
    101   1.1  jmcneill 	itimer.it_value = itimer.it_interval;
    102   1.6  jmcneill 	thunk_setitimer(ITIMER_REAL, &itimer, NULL);
    103   1.2     joerg 
    104   1.9  jmcneill 	tcres = thunk_clock_getres_monotonic();
    105   1.9  jmcneill 	if (tcres > 0) {
    106   1.8  jmcneill 		clock_timecounter.tc_quality = 1000;
    107   1.9  jmcneill 		clock_timecounter.tc_frequency = 1000000000 / tcres;
    108   1.8  jmcneill 	}
    109   1.2     joerg 	tc_init(&clock_timecounter);
    110   1.1  jmcneill }
    111   1.1  jmcneill 
    112   1.1  jmcneill static void
    113   1.1  jmcneill clock_intr(int notused)
    114   1.1  jmcneill {
    115   1.1  jmcneill 	extern int usermode_x;
    116   1.1  jmcneill 	struct clockframe cf;
    117   1.1  jmcneill 
    118   1.7  jmcneill 	curcpu()->ci_idepth++;
    119   1.1  jmcneill 
    120   1.1  jmcneill 	hardclock(&cf);
    121   1.7  jmcneill 
    122   1.7  jmcneill 	curcpu()->ci_idepth--;
    123   1.1  jmcneill }
    124   1.2     joerg 
    125  1.10  jmcneill static unsigned int
    126   1.2     joerg clock_getcounter(struct timecounter *tc)
    127   1.2     joerg {
    128  1.10  jmcneill 	return thunk_getcounter();
    129   1.8  jmcneill }
    130   1.8  jmcneill 
    131   1.8  jmcneill static int
    132   1.8  jmcneill clock_todr_gettime(struct todr_chip_handle *tch, struct timeval *tv)
    133   1.8  jmcneill {
    134  1.10  jmcneill 	struct thunk_timeval ttv;
    135  1.10  jmcneill 	int error;
    136  1.10  jmcneill 
    137  1.10  jmcneill 	error = thunk_gettimeofday(&ttv, NULL);
    138  1.10  jmcneill 	if (error)
    139  1.10  jmcneill 		return error;
    140  1.10  jmcneill 
    141  1.10  jmcneill 	tv->tv_sec = ttv.tv_sec;
    142  1.10  jmcneill 	tv->tv_usec = ttv.tv_usec;
    143  1.10  jmcneill 
    144  1.10  jmcneill 	return 0;
    145   1.2     joerg }
    146