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