kernel: Make SMP support default (and non-optional).
[dragonfly.git] / sys / platform / vkernel / platform / systimer.c
CommitLineData
6f7b98e0
MD
1/*
2 * Copyright (c) 2006 The DragonFly Project. All rights reserved.
3 *
4 * This code is derived from software contributed to The DragonFly Project
5 * by Matthew Dillon <dillon@backplane.com>
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in
15 * the documentation and/or other materials provided with the
16 * distribution.
17 * 3. Neither the name of The DragonFly Project nor the names of its
18 * contributors may be used to endorse or promote products derived
19 * from this software without specific, prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
27 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
29 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
30 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
31 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
6f7b98e0
MD
33 */
34
35#include <sys/types.h>
36#include <sys/systm.h>
37#include <sys/kernel.h>
38#include <sys/systimer.h>
39#include <sys/sysctl.h>
60297eb4 40#include <sys/signal.h>
1130c186
MD
41#include <sys/interrupt.h>
42#include <sys/bus.h>
60297eb4 43#include <sys/time.h>
6f7b98e0 44#include <machine/cpu.h>
870b0161 45#include <machine/clock.h>
1130c186 46#include <machine/globaldata.h>
7c1212ec 47#include <machine/md_var.h>
6f7b98e0 48
1fdc022f
MD
49#include <sys/thread2.h>
50
6f7b98e0 51#include <unistd.h>
60297eb4 52#include <signal.h>
6f7b98e0 53
ef612539
SZ
54#define VKTIMER_FREQ 1000000 /* 1us granularity */
55
56static void vktimer_intr(void *dummy, struct intrframe *frame);
9aeb4297 57
6f7b98e0
MD
58int disable_rtc_set;
59SYSCTL_INT(_machdep, CPU_DISRTCSET, disable_rtc_set,
60 CTLFLAG_RW, &disable_rtc_set, 0, "");
870b0161
MD
61SYSCTL_INT(_hw, OID_AUTO, tsc_present, CTLFLAG_RD,
62 &tsc_present, 0, "TSC Available");
63SYSCTL_QUAD(_hw, OID_AUTO, tsc_frequency, CTLFLAG_RD,
64 &tsc_frequency, 0, "TSC Frequency");
6f7b98e0
MD
65
66int adjkerntz;
60297eb4 67int wall_cmos_clock = 0;
9aeb4297
MD
68static struct kqueue_info *kqueue_timer_info;
69
0a76854c
MD
70static int cputimer_mib[16];
71static int cputimer_miblen;
72
60297eb4
MD
73/*
74 * SYSTIMER IMPLEMENTATION
75 */
76static sysclock_t vkernel_timer_get_timecount(void);
77static void vkernel_timer_construct(struct cputimer *timer, sysclock_t oclock);
60297eb4
MD
78
79static struct cputimer vkernel_cputimer = {
80 SLIST_ENTRY_INITIALIZER,
81 "VKERNEL",
82 CPUTIMER_PRI_VKERNEL,
83 CPUTIMER_VKERNEL,
84 vkernel_timer_get_timecount,
85 cputimer_default_fromhz,
86 cputimer_default_fromus,
87 vkernel_timer_construct,
88 cputimer_default_destruct,
ef612539 89 VKTIMER_FREQ,
60297eb4
MD
90 0, 0, 0
91};
92
ef612539 93static void vktimer_intr_reload(struct cputimer_intr *, sysclock_t);
d1ada0d8 94static void vktimer_intr_initclock(struct cputimer_intr *, boolean_t);
ef612539
SZ
95
96static struct cputimer_intr vkernel_cputimer_intr = {
97 .freq = VKTIMER_FREQ,
98 .reload = vktimer_intr_reload,
99 .enable = cputimer_intr_default_enable,
100 .config = cputimer_intr_default_config,
101 .restart = cputimer_intr_default_restart,
102 .pmfixup = cputimer_intr_default_pmfixup,
103 .initclock = vktimer_intr_initclock,
104 .next = SLIST_ENTRY_INITIALIZER,
105 .name = "vkernel",
106 .type = CPUTIMER_INTR_VKERNEL,
107 .prio = CPUTIMER_INTR_PRIO_VKERNEL,
108 .caps = CPUTIMER_INTR_CAP_NONE
109};
110
60297eb4
MD
111/*
112 * Initialize the systimer subsystem, called from MI code in early boot.
113 */
d1ada0d8 114static void
38015462 115cpu_initclocks(void *arg __unused)
6f7b98e0 116{
0a76854c 117 int len;
d1ada0d8 118
60297eb4 119 kprintf("initclocks\n");
0a76854c
MD
120 len = sizeof(vkernel_cputimer.freq);
121 if (sysctlbyname("kern.cputimer.freq", &vkernel_cputimer.freq, &len,
201b3f37 122 NULL, 0) < 0) {
0a76854c
MD
123 panic("cpu_initclocks: can't get kern.cputimer.freq!");
124 }
c157ff7a 125 len = NELEM(cputimer_mib);
0a76854c
MD
126 if (sysctlnametomib("kern.cputimer.clock", cputimer_mib, &len) < 0)
127 panic("cpu_initclocks: can't get kern.cputimer.clock!");
128 cputimer_miblen = len;
ef612539
SZ
129
130 cputimer_intr_register(&vkernel_cputimer_intr);
131 cputimer_intr_select(&vkernel_cputimer_intr, 0);
132
60297eb4
MD
133 cputimer_register(&vkernel_cputimer);
134 cputimer_select(&vkernel_cputimer, 0);
135}
ba39e2e0 136SYSINIT(clocksvk, SI_BOOT2_CLOCKREG, SI_ORDER_FIRST, cpu_initclocks, NULL)
60297eb4
MD
137
138/*
139 * Constructor to initialize timer->base and get an initial count.
140 */
141static void
142vkernel_timer_construct(struct cputimer *timer, sysclock_t oclock)
143{
144 timer->base = 0;
145 timer->base = oclock - vkernel_timer_get_timecount();
146}
147
148/*
149 * Get the current counter, with 2's complement rollover.
0a76854c
MD
150 *
151 * NOTE! MPSAFE, possibly no critical section
60297eb4
MD
152 */
153static sysclock_t
154vkernel_timer_get_timecount(void)
155{
60297eb4 156 sysclock_t counter;
2b41ad07 157 size_t len;
60297eb4 158
0a76854c
MD
159 len = sizeof(counter);
160 if (sysctl(cputimer_mib, cputimer_miblen, &counter, &len,
201b3f37 161 NULL, 0) < 0) {
0a76854c
MD
162 panic("vkernel_timer_get_timecount: sysctl failed!");
163 }
60297eb4 164 return(counter);
6f7b98e0
MD
165}
166
60297eb4 167/*
ef612539 168 * Initialize the interrupt for our core systimer. Use the kqueue timer
9aeb4297 169 * support functions.
60297eb4 170 */
ef612539 171static void
d1ada0d8
SZ
172vktimer_intr_initclock(struct cputimer_intr *cti __unused,
173 boolean_t selected __unused)
6f7b98e0 174{
ef612539
SZ
175 KKASSERT(kqueue_timer_info == NULL);
176 kqueue_timer_info = kqueue_add_timer(vktimer_intr, NULL);
6f7b98e0
MD
177}
178
60297eb4 179/*
307ae84d
MD
180 * Reload the interrupt for our core systimer. Because the caller's
181 * reload calculation can be negatively indexed, we need a minimal
182 * check to ensure that a reasonable reload value is selected.
60297eb4 183 */
c5b8324c 184static void
ef612539 185vktimer_intr_reload(struct cputimer_intr *cti __unused, sysclock_t reload)
6f7b98e0 186{
307ae84d
MD
187 if (kqueue_timer_info) {
188 if ((int)reload < 1)
189 reload = 1;
9aeb4297 190 kqueue_reload_timer(kqueue_timer_info, (reload + 999) / 1000);
307ae84d 191 }
60297eb4
MD
192}
193
4b486183
MD
194/*
195 * clock interrupt.
196 *
197 * NOTE: frame is a struct intrframe pointer.
198 */
9aeb4297 199static void
ef612539 200vktimer_intr(void *dummy, struct intrframe *frame)
60297eb4
MD
201{
202 static sysclock_t sysclock_count;
203 struct globaldata *gd = mycpu;
60297eb4
MD
204 struct globaldata *gscan;
205 int n;
9aeb4297 206
60297eb4 207 sysclock_count = sys_cputimer->count();
60297eb4
MD
208 for (n = 0; n < ncpus; ++n) {
209 gscan = globaldata_find(n);
210 if (TAILQ_FIRST(&gscan->gd_systimerq) == NULL)
211 continue;
212 if (gscan != gd) {
213 lwkt_send_ipiq3(gscan, (ipifunc3_t)systimer_intr,
214 &sysclock_count, 0);
215 } else {
4b486183 216 systimer_intr(&sysclock_count, 0, frame);
60297eb4
MD
217 }
218 }
6f7b98e0
MD
219}
220
221/*
222 * Initialize the time of day register, based on the time base which is, e.g.
223 * from a filesystem.
224 */
225void
226inittodr(time_t base)
227{
0171c06b
MD
228 struct timespec ts;
229 struct timeval tv;
230
231 gettimeofday(&tv, NULL);
232 ts.tv_sec = tv.tv_sec;
233 ts.tv_nsec = tv.tv_usec * 1000;
234 set_timeofday(&ts);
6f7b98e0
MD
235}
236
237/*
238 * Write system time back to the RTC
239 */
240void
241resettodr(void)
242{
6f7b98e0
MD
243}
244
03bcb4ab
MD
245/*
246 * We need to enter a critical section to prevent signals from recursing
247 * into pthreads.
248 */
6f7b98e0
MD
249void
250DELAY(int usec)
251{
03bcb4ab 252 crit_enter();
6f7b98e0 253 usleep(usec);
03bcb4ab 254 crit_exit();
6f7b98e0
MD
255}
256
dbcd0c9b
MD
257void
258DRIVERSLEEP(int usec)
259{
260 if (mycpu->gd_intr_nesting_level)
261 DELAY(usec);
262 else if (1000000 / usec >= hz)
263 tsleep(DRIVERSLEEP, 0, "DELAY", 1000000 / usec / hz + 1);
264 else
03bcb4ab 265 DELAY(usec);
dbcd0c9b
MD
266}
267