clock.c revision 1.2 1 1.2 joerg /* $NetBSD: clock.c,v 1.2 2008/01/07 17:27:12 joerg 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 * 3. All advertising materials mentioning features or use of this software
16 1.1 jmcneill * must display the following acknowledgement:
17 1.1 jmcneill * This product includes software developed by Jared D. McNeill.
18 1.1 jmcneill * 4. Neither the name of The NetBSD Foundation nor the names of its
19 1.1 jmcneill * contributors may be used to endorse or promote products derived
20 1.1 jmcneill * from this software without specific prior written permission.
21 1.1 jmcneill *
22 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
23 1.1 jmcneill * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
24 1.1 jmcneill * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
25 1.1 jmcneill * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
26 1.1 jmcneill * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 1.1 jmcneill * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 1.1 jmcneill * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 1.1 jmcneill * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 1.1 jmcneill * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 1.1 jmcneill * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 1.1 jmcneill * POSSIBILITY OF SUCH DAMAGE.
33 1.1 jmcneill */
34 1.1 jmcneill
35 1.1 jmcneill #include <sys/cdefs.h>
36 1.2 joerg __KERNEL_RCSID(0, "$NetBSD: clock.c,v 1.2 2008/01/07 17:27:12 joerg Exp $");
37 1.1 jmcneill
38 1.1 jmcneill #include <sys/param.h>
39 1.1 jmcneill #include <sys/proc.h>
40 1.1 jmcneill #include <sys/user.h>
41 1.1 jmcneill #include <sys/systm.h>
42 1.1 jmcneill #include <sys/device.h>
43 1.2 joerg #include <sys/timetc.h>
44 1.1 jmcneill
45 1.1 jmcneill #include <machine/mainbus.h>
46 1.1 jmcneill
47 1.1 jmcneill static int clock_match(device_t, cfdata_t, void *);
48 1.1 jmcneill static void clock_attach(device_t, device_t, void *);
49 1.1 jmcneill
50 1.1 jmcneill static void clock_intr(int);
51 1.2 joerg static u_int clock_getcounter(struct timecounter *);
52 1.1 jmcneill
53 1.1 jmcneill typedef struct clock_softc {
54 1.1 jmcneill device_t sc_dev;
55 1.1 jmcneill } clock_softc_t;
56 1.1 jmcneill
57 1.1 jmcneill extern int setitimer(int, const struct itimerval *, struct itimerval *);
58 1.1 jmcneill
59 1.2 joerg static struct timecounter clock_timecounter = {
60 1.2 joerg clock_getcounter, /* get_timecount */
61 1.2 joerg 0, /* no poll_pps */
62 1.2 joerg ~0u, /* counter_mask */
63 1.2 joerg 1000000, /* frequency */
64 1.2 joerg "gettimeofday", /* name */
65 1.2 joerg 100, /* quality */
66 1.2 joerg NULL, /* prev */
67 1.2 joerg NULL, /* next */
68 1.2 joerg };
69 1.2 joerg
70 1.1 jmcneill CFATTACH_DECL_NEW(clock, sizeof(clock_softc_t),
71 1.1 jmcneill clock_match, clock_attach, NULL, NULL);
72 1.1 jmcneill
73 1.1 jmcneill static int
74 1.1 jmcneill clock_match(device_t parent, cfdata_t match, void *opaque)
75 1.1 jmcneill {
76 1.1 jmcneill struct thunkbus_attach_args *taa = opaque;
77 1.1 jmcneill
78 1.1 jmcneill if (taa->taa_type != THUNKBUS_TYPE_CLOCK)
79 1.1 jmcneill return 0;
80 1.1 jmcneill
81 1.1 jmcneill return 1;
82 1.1 jmcneill }
83 1.1 jmcneill
84 1.1 jmcneill static void
85 1.1 jmcneill clock_attach(device_t parent, device_t self, void *opaque)
86 1.1 jmcneill {
87 1.1 jmcneill clock_softc_t *sc = device_private(self);
88 1.1 jmcneill struct itimerval itimer;
89 1.1 jmcneill
90 1.1 jmcneill aprint_naive("\n");
91 1.1 jmcneill aprint_normal("\n");
92 1.1 jmcneill
93 1.1 jmcneill sc->sc_dev = self;
94 1.1 jmcneill
95 1.1 jmcneill (void)signal(SIGALRM, clock_intr);
96 1.1 jmcneill
97 1.1 jmcneill itimer.it_interval.tv_sec = 0;
98 1.1 jmcneill itimer.it_interval.tv_usec = 10000;
99 1.1 jmcneill itimer.it_value = itimer.it_interval;
100 1.1 jmcneill (void)setitimer(ITIMER_REAL, &itimer, NULL);
101 1.2 joerg
102 1.2 joerg tc_init(&clock_timecounter);
103 1.1 jmcneill }
104 1.1 jmcneill
105 1.1 jmcneill static void
106 1.1 jmcneill clock_intr(int notused)
107 1.1 jmcneill {
108 1.1 jmcneill extern int usermode_x;
109 1.1 jmcneill struct clockframe cf;
110 1.1 jmcneill
111 1.1 jmcneill #if notyet
112 1.1 jmcneill /* XXXJDM */
113 1.1 jmcneill if (usermode_x > IPL_SOFTCLOCK)
114 1.1 jmcneill return;
115 1.1 jmcneill #endif
116 1.1 jmcneill
117 1.1 jmcneill hardclock(&cf);
118 1.1 jmcneill }
119 1.2 joerg
120 1.2 joerg static u_int
121 1.2 joerg clock_getcounter(struct timecounter *tc)
122 1.2 joerg {
123 1.2 joerg extern int gettimeofday(struct timeval *, void *);
124 1.2 joerg struct timeval tv;
125 1.2 joerg
126 1.2 joerg gettimeofday(&tv, NULL);
127 1.2 joerg return tv.tv_sec * 1000000 + tv.tv_usec;
128 1.2 joerg }
129