Home | History | Annotate | Line # | Download | only in dev
clock.c revision 1.5
      1  1.5  jmcneill /* $NetBSD: clock.c,v 1.5 2011/08/10 01:32:44 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.5  jmcneill __KERNEL_RCSID(0, "$NetBSD: clock.c,v 1.5 2011/08/10 01:32:44 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.1  jmcneill 
     41  1.1  jmcneill static int	clock_match(device_t, cfdata_t, void *);
     42  1.1  jmcneill static void	clock_attach(device_t, device_t, void *);
     43  1.1  jmcneill 
     44  1.1  jmcneill static void 	clock_intr(int);
     45  1.2     joerg static u_int	clock_getcounter(struct timecounter *);
     46  1.1  jmcneill 
     47  1.1  jmcneill typedef struct clock_softc {
     48  1.1  jmcneill 	device_t	sc_dev;
     49  1.1  jmcneill } clock_softc_t;
     50  1.1  jmcneill 
     51  1.1  jmcneill extern int	setitimer(int, const struct itimerval *, struct itimerval *);
     52  1.1  jmcneill 
     53  1.2     joerg static struct timecounter clock_timecounter = {
     54  1.2     joerg 	clock_getcounter,	/* get_timecount */
     55  1.2     joerg 	0,			/* no poll_pps */
     56  1.2     joerg 	~0u,			/* counter_mask */
     57  1.2     joerg 	1000000,		/* frequency */
     58  1.2     joerg 	"gettimeofday",		/* name */
     59  1.2     joerg 	100,			/* quality */
     60  1.2     joerg 	NULL,			/* prev */
     61  1.2     joerg 	NULL,			/* next */
     62  1.2     joerg };
     63  1.2     joerg 
     64  1.1  jmcneill CFATTACH_DECL_NEW(clock, sizeof(clock_softc_t),
     65  1.1  jmcneill     clock_match, clock_attach, NULL, NULL);
     66  1.1  jmcneill 
     67  1.1  jmcneill static int
     68  1.1  jmcneill clock_match(device_t parent, cfdata_t match, void *opaque)
     69  1.1  jmcneill {
     70  1.1  jmcneill 	struct thunkbus_attach_args *taa = opaque;
     71  1.1  jmcneill 
     72  1.1  jmcneill 	if (taa->taa_type != THUNKBUS_TYPE_CLOCK)
     73  1.1  jmcneill 		return 0;
     74  1.1  jmcneill 
     75  1.1  jmcneill 	return 1;
     76  1.1  jmcneill }
     77  1.1  jmcneill 
     78  1.1  jmcneill static void
     79  1.1  jmcneill clock_attach(device_t parent, device_t self, void *opaque)
     80  1.1  jmcneill {
     81  1.1  jmcneill 	clock_softc_t *sc = device_private(self);
     82  1.1  jmcneill 	struct itimerval itimer;
     83  1.1  jmcneill 
     84  1.1  jmcneill 	aprint_naive("\n");
     85  1.1  jmcneill 	aprint_normal("\n");
     86  1.1  jmcneill 
     87  1.1  jmcneill 	sc->sc_dev = self;
     88  1.1  jmcneill 
     89  1.1  jmcneill 	(void)signal(SIGALRM, clock_intr);
     90  1.1  jmcneill 
     91  1.1  jmcneill 	itimer.it_interval.tv_sec = 0;
     92  1.1  jmcneill 	itimer.it_interval.tv_usec = 10000;
     93  1.1  jmcneill 	itimer.it_value = itimer.it_interval;
     94  1.1  jmcneill 	(void)setitimer(ITIMER_REAL, &itimer, NULL);
     95  1.2     joerg 
     96  1.2     joerg 	tc_init(&clock_timecounter);
     97  1.1  jmcneill }
     98  1.1  jmcneill 
     99  1.1  jmcneill static void
    100  1.1  jmcneill clock_intr(int notused)
    101  1.1  jmcneill {
    102  1.1  jmcneill 	extern int usermode_x;
    103  1.1  jmcneill 	struct clockframe cf;
    104  1.1  jmcneill 
    105  1.1  jmcneill #if notyet
    106  1.1  jmcneill 	/* XXXJDM */
    107  1.1  jmcneill 	if (usermode_x > IPL_SOFTCLOCK)
    108  1.1  jmcneill 		return;
    109  1.1  jmcneill #endif
    110  1.1  jmcneill 
    111  1.1  jmcneill 	hardclock(&cf);
    112  1.1  jmcneill }
    113  1.2     joerg 
    114  1.2     joerg static u_int
    115  1.2     joerg clock_getcounter(struct timecounter *tc)
    116  1.2     joerg {
    117  1.2     joerg 	extern int gettimeofday(struct timeval *, void *);
    118  1.2     joerg 	struct timeval tv;
    119  1.2     joerg 
    120  1.2     joerg 	gettimeofday(&tv, NULL);
    121  1.2     joerg 	return tv.tv_sec * 1000000 + tv.tv_usec;
    122  1.2     joerg }
    123