xref: /freebsd/sys/kern/kern_clocksource.c (revision a889a65ba36985dfb31111ac1607be35ca2b2c8c)
143fe7d45SAlexander Motin /*-
28a36da99SPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
38a36da99SPedro F. Giffuni  *
45b999a6bSDavide Italiano  * Copyright (c) 2010-2013 Alexander Motin <mav@FreeBSD.org>
543fe7d45SAlexander Motin  * All rights reserved.
643fe7d45SAlexander Motin  *
743fe7d45SAlexander Motin  * Redistribution and use in source and binary forms, with or without
843fe7d45SAlexander Motin  * modification, are permitted provided that the following conditions
943fe7d45SAlexander Motin  * are met:
1043fe7d45SAlexander Motin  * 1. Redistributions of source code must retain the above copyright
1143fe7d45SAlexander Motin  *    notice, this list of conditions and the following disclaimer,
1243fe7d45SAlexander Motin  *    without modification, immediately at the beginning of the file.
1343fe7d45SAlexander Motin  * 2. Redistributions in binary form must reproduce the above copyright
1443fe7d45SAlexander Motin  *    notice, this list of conditions and the following disclaimer in the
1543fe7d45SAlexander Motin  *    documentation and/or other materials provided with the distribution.
1643fe7d45SAlexander Motin  *
1743fe7d45SAlexander Motin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
1843fe7d45SAlexander Motin  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1943fe7d45SAlexander Motin  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
2043fe7d45SAlexander Motin  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
2143fe7d45SAlexander Motin  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2243fe7d45SAlexander Motin  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2343fe7d45SAlexander Motin  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2443fe7d45SAlexander Motin  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2543fe7d45SAlexander Motin  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2643fe7d45SAlexander Motin  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2743fe7d45SAlexander Motin  */
2843fe7d45SAlexander Motin 
2943fe7d45SAlexander Motin #include <sys/cdefs.h>
3043fe7d45SAlexander Motin __FBSDID("$FreeBSD$");
3143fe7d45SAlexander Motin 
3243fe7d45SAlexander Motin /*
3343fe7d45SAlexander Motin  * Common routines to manage event timers hardware.
3443fe7d45SAlexander Motin  */
3543fe7d45SAlexander Motin 
369dfc483cSAlexander Motin #include "opt_device_polling.h"
3743fe7d45SAlexander Motin 
3843fe7d45SAlexander Motin #include <sys/param.h>
3943fe7d45SAlexander Motin #include <sys/systm.h>
4043fe7d45SAlexander Motin #include <sys/bus.h>
415b999a6bSDavide Italiano #include <sys/limits.h>
4243fe7d45SAlexander Motin #include <sys/lock.h>
4343fe7d45SAlexander Motin #include <sys/kdb.h>
44a157e425SAlexander Motin #include <sys/ktr.h>
4543fe7d45SAlexander Motin #include <sys/mutex.h>
4643fe7d45SAlexander Motin #include <sys/proc.h>
4743fe7d45SAlexander Motin #include <sys/kernel.h>
4843fe7d45SAlexander Motin #include <sys/sched.h>
4943fe7d45SAlexander Motin #include <sys/smp.h>
5043fe7d45SAlexander Motin #include <sys/sysctl.h>
5143fe7d45SAlexander Motin #include <sys/timeet.h>
520e189873SAlexander Motin #include <sys/timetc.h>
5343fe7d45SAlexander Motin 
5443fe7d45SAlexander Motin #include <machine/atomic.h>
5543fe7d45SAlexander Motin #include <machine/clock.h>
5643fe7d45SAlexander Motin #include <machine/cpu.h>
5743fe7d45SAlexander Motin #include <machine/smp.h>
5843fe7d45SAlexander Motin 
5992597e06SJohn Baldwin int			cpu_disable_c2_sleep = 0; /* Timer dies in C2. */
6092597e06SJohn Baldwin int			cpu_disable_c3_sleep = 0; /* Timer dies in C3. */
6143fe7d45SAlexander Motin 
62a157e425SAlexander Motin static void		setuptimer(void);
635b999a6bSDavide Italiano static void		loadtimer(sbintime_t now, int first);
64a157e425SAlexander Motin static int		doconfigtimer(void);
65a157e425SAlexander Motin static void		configtimer(int start);
66a157e425SAlexander Motin static int		round_freq(struct eventtimer *et, int freq);
6743fe7d45SAlexander Motin 
68ebb3cb61SMark Johnston struct pcpu_state;
69ebb3cb61SMark Johnston static sbintime_t	getnextcpuevent(struct pcpu_state *state, int idle);
70ebb3cb61SMark Johnston static sbintime_t	getnextevent(struct pcpu_state *state);
715b999a6bSDavide Italiano static int		handleevents(sbintime_t now, int fake);
7243fe7d45SAlexander Motin 
73a157e425SAlexander Motin static struct mtx	et_hw_mtx;
74a157e425SAlexander Motin 
75a157e425SAlexander Motin #define	ET_HW_LOCK(state)						\
76a157e425SAlexander Motin 	{								\
77a157e425SAlexander Motin 		if (timer->et_flags & ET_FLAGS_PERCPU)			\
78a157e425SAlexander Motin 			mtx_lock_spin(&(state)->et_hw_mtx);		\
79a157e425SAlexander Motin 		else							\
80a157e425SAlexander Motin 			mtx_lock_spin(&et_hw_mtx);			\
81a157e425SAlexander Motin 	}
82a157e425SAlexander Motin 
83a157e425SAlexander Motin #define	ET_HW_UNLOCK(state)						\
84a157e425SAlexander Motin 	{								\
85a157e425SAlexander Motin 		if (timer->et_flags & ET_FLAGS_PERCPU)			\
86a157e425SAlexander Motin 			mtx_unlock_spin(&(state)->et_hw_mtx);		\
87a157e425SAlexander Motin 		else							\
88a157e425SAlexander Motin 			mtx_unlock_spin(&et_hw_mtx);			\
89a157e425SAlexander Motin 	}
90a157e425SAlexander Motin 
91a157e425SAlexander Motin static struct eventtimer *timer = NULL;
925b999a6bSDavide Italiano static sbintime_t	timerperiod;	/* Timer period for periodic mode. */
935b999a6bSDavide Italiano static sbintime_t	statperiod;	/* statclock() events period. */
945b999a6bSDavide Italiano static sbintime_t	profperiod;	/* profclock() events period. */
955b999a6bSDavide Italiano static sbintime_t	nexttick;	/* Next global timer tick time. */
965b999a6bSDavide Italiano static u_int		busy = 1;	/* Reconfiguration is in progress. */
97af3b2549SHans Petter Selasky static int		profiling;	/* Profiling events enabled. */
98a157e425SAlexander Motin 
99a157e425SAlexander Motin static char		timername[32];	/* Wanted timer. */
100a157e425SAlexander Motin TUNABLE_STR("kern.eventtimer.timer", timername, sizeof(timername));
101a157e425SAlexander Motin 
102af3b2549SHans Petter Selasky static int		singlemul;	/* Multiplier for periodic mode. */
103af3b2549SHans Petter Selasky SYSCTL_INT(_kern_eventtimer, OID_AUTO, singlemul, CTLFLAG_RWTUN, &singlemul,
104a157e425SAlexander Motin     0, "Multiplier for periodic mode");
10543fe7d45SAlexander Motin 
106af3b2549SHans Petter Selasky static u_int		idletick;	/* Run periodic events when idle. */
107af3b2549SHans Petter Selasky SYSCTL_UINT(_kern_eventtimer, OID_AUTO, idletick, CTLFLAG_RWTUN, &idletick,
108a157e425SAlexander Motin     0, "Run periodic events when idle");
109a157e425SAlexander Motin 
110af3b2549SHans Petter Selasky static int		periodic;	/* Periodic or one-shot mode. */
111af3b2549SHans Petter Selasky static int		want_periodic;	/* What mode to prefer. */
112afe41f2dSAlexander Motin TUNABLE_INT("kern.eventtimer.periodic", &want_periodic);
113a157e425SAlexander Motin 
114a157e425SAlexander Motin struct pcpu_state {
115a157e425SAlexander Motin 	struct mtx	et_hw_mtx;	/* Per-CPU timer mutex. */
116a157e425SAlexander Motin 	u_int		action;		/* Reconfiguration requests. */
117a157e425SAlexander Motin 	u_int		handle;		/* Immediate handle resuests. */
1185b999a6bSDavide Italiano 	sbintime_t	now;		/* Last tick time. */
1195b999a6bSDavide Italiano 	sbintime_t	nextevent;	/* Next scheduled event on this CPU. */
1205b999a6bSDavide Italiano 	sbintime_t	nexttick;	/* Next timer tick time. */
121d3e2e28eSAlexander Motin 	sbintime_t	nexthard;	/* Next hardclock() event. */
1225b999a6bSDavide Italiano 	sbintime_t	nextstat;	/* Next statclock() event. */
1235b999a6bSDavide Italiano 	sbintime_t	nextprof;	/* Next profclock() event. */
1245b999a6bSDavide Italiano 	sbintime_t	nextcall;	/* Next callout event. */
1255b999a6bSDavide Italiano 	sbintime_t	nextcallopt;	/* Next optional callout event. */
126a157e425SAlexander Motin 	int		ipi;		/* This CPU needs IPI. */
127a157e425SAlexander Motin 	int		idle;		/* This CPU is in idle mode. */
128a157e425SAlexander Motin };
129a157e425SAlexander Motin 
1302bf95012SAndrew Turner DPCPU_DEFINE_STATIC(struct pcpu_state, timerstate);
1315b999a6bSDavide Italiano DPCPU_DEFINE(sbintime_t, hardclocktime);
132fdc5dd2dSAlexander Motin 
133a157e425SAlexander Motin /*
134a157e425SAlexander Motin  * Timer broadcast IPI handler.
135a157e425SAlexander Motin  */
136a157e425SAlexander Motin int
137a157e425SAlexander Motin hardclockintr(void)
13843fe7d45SAlexander Motin {
1395b999a6bSDavide Italiano 	sbintime_t now;
140a157e425SAlexander Motin 	struct pcpu_state *state;
141a157e425SAlexander Motin 	int done;
14243fe7d45SAlexander Motin 
143a157e425SAlexander Motin 	if (doconfigtimer() || busy)
144a157e425SAlexander Motin 		return (FILTER_HANDLED);
145a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
146a157e425SAlexander Motin 	now = state->now;
1475b999a6bSDavide Italiano 	CTR3(KTR_SPARE2, "ipi  at %d:    now  %d.%08x",
1485b999a6bSDavide Italiano 	    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff));
1495b999a6bSDavide Italiano 	done = handleevents(now, 0);
150a157e425SAlexander Motin 	return (done ? FILTER_HANDLED : FILTER_STRAY);
151a157e425SAlexander Motin }
152a157e425SAlexander Motin 
153a157e425SAlexander Motin /*
154a157e425SAlexander Motin  * Handle all events for specified time on this CPU
155a157e425SAlexander Motin  */
156a157e425SAlexander Motin static int
1575b999a6bSDavide Italiano handleevents(sbintime_t now, int fake)
158a157e425SAlexander Motin {
1595b999a6bSDavide Italiano 	sbintime_t t, *hct;
160a157e425SAlexander Motin 	struct trapframe *frame;
161a157e425SAlexander Motin 	struct pcpu_state *state;
162a157e425SAlexander Motin 	int usermode;
163a157e425SAlexander Motin 	int done, runs;
164a157e425SAlexander Motin 
1655b999a6bSDavide Italiano 	CTR3(KTR_SPARE2, "handle at %d:  now  %d.%08x",
1665b999a6bSDavide Italiano 	    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff));
167a157e425SAlexander Motin 	done = 0;
168a157e425SAlexander Motin 	if (fake) {
169a157e425SAlexander Motin 		frame = NULL;
170a157e425SAlexander Motin 		usermode = 0;
171a157e425SAlexander Motin 	} else {
172a157e425SAlexander Motin 		frame = curthread->td_intr_frame;
173a157e425SAlexander Motin 		usermode = TRAPF_USERMODE(frame);
174a157e425SAlexander Motin 	}
175dd7498aeSAndriy Gapon 
176a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
177dd7498aeSAndriy Gapon 
178bcfd016cSAlexander Motin 	runs = 0;
1795b999a6bSDavide Italiano 	while (now >= state->nexthard) {
1805b999a6bSDavide Italiano 		state->nexthard += tick_sbt;
181a157e425SAlexander Motin 		runs++;
18243fe7d45SAlexander Motin 	}
183c0722d20SAlexander Motin 	if (runs) {
1845b999a6bSDavide Italiano 		hct = DPCPU_PTR(hardclocktime);
1855b999a6bSDavide Italiano 		*hct = state->nexthard - tick_sbt;
186c0722d20SAlexander Motin 		if (fake < 2) {
187cc4f3d0aSMark Johnston 			hardclock(runs, usermode);
188a157e425SAlexander Motin 			done = 1;
18943fe7d45SAlexander Motin 		}
190c0722d20SAlexander Motin 	}
191bcfd016cSAlexander Motin 	runs = 0;
1925b999a6bSDavide Italiano 	while (now >= state->nextstat) {
1935b999a6bSDavide Italiano 		state->nextstat += statperiod;
194bcfd016cSAlexander Motin 		runs++;
195bcfd016cSAlexander Motin 	}
196bcfd016cSAlexander Motin 	if (runs && fake < 2) {
197cc4f3d0aSMark Johnston 		statclock(runs, usermode);
198a157e425SAlexander Motin 		done = 1;
19943fe7d45SAlexander Motin 	}
200a157e425SAlexander Motin 	if (profiling) {
201bcfd016cSAlexander Motin 		runs = 0;
2025b999a6bSDavide Italiano 		while (now >= state->nextprof) {
2035b999a6bSDavide Italiano 			state->nextprof += profperiod;
204bcfd016cSAlexander Motin 			runs++;
205bcfd016cSAlexander Motin 		}
206bcfd016cSAlexander Motin 		if (runs && !fake) {
207cc4f3d0aSMark Johnston 			profclock(runs, usermode, TRAPF_PC(frame));
208a157e425SAlexander Motin 			done = 1;
20943fe7d45SAlexander Motin 		}
210a157e425SAlexander Motin 	} else
211a157e425SAlexander Motin 		state->nextprof = state->nextstat;
21210c87557SHans Petter Selasky 	if (now >= state->nextcallopt || now >= state->nextcall) {
2134bc38a5aSDavide Italiano 		state->nextcall = state->nextcallopt = SBT_MAX;
2145b999a6bSDavide Italiano 		callout_process(now);
2155b999a6bSDavide Italiano 	}
216dd7498aeSAndriy Gapon 
217a157e425SAlexander Motin 	ET_HW_LOCK(state);
218*a889a65bSMark Johnston 	t = getnextcpuevent(state, 0);
219a157e425SAlexander Motin 	if (!busy) {
220a157e425SAlexander Motin 		state->idle = 0;
221a157e425SAlexander Motin 		state->nextevent = t;
222e37e08c7SAlexander Motin 		loadtimer(now, (fake == 2) &&
223e37e08c7SAlexander Motin 		    (timer->et_flags & ET_FLAGS_PERCPU));
22443fe7d45SAlexander Motin 	}
225a157e425SAlexander Motin 	ET_HW_UNLOCK(state);
226a157e425SAlexander Motin 	return (done);
22743fe7d45SAlexander Motin }
22843fe7d45SAlexander Motin 
22943fe7d45SAlexander Motin /*
230a157e425SAlexander Motin  * Schedule binuptime of the next event on current CPU.
23143fe7d45SAlexander Motin  */
2325b999a6bSDavide Italiano static sbintime_t
233ebb3cb61SMark Johnston getnextcpuevent(struct pcpu_state *state, int idle)
23443fe7d45SAlexander Motin {
2355b999a6bSDavide Italiano 	sbintime_t event;
2365b999a6bSDavide Italiano 	u_int hardfreq;
23743fe7d45SAlexander Motin 
2385b999a6bSDavide Italiano 	/* Handle hardclock() events, skipping some if CPU is idle. */
2395b999a6bSDavide Italiano 	event = state->nexthard;
2405b999a6bSDavide Italiano 	if (idle) {
241cb1f5d11SAlexander Motin 		if (tc_min_ticktock_freq > 1
2425b999a6bSDavide Italiano #ifdef SMP
2435b999a6bSDavide Italiano 		    && curcpu == CPU_FIRST()
2445b999a6bSDavide Italiano #endif
2455b999a6bSDavide Italiano 		    )
2465b999a6bSDavide Italiano 			hardfreq = hz / tc_min_ticktock_freq;
247cb1f5d11SAlexander Motin 		else
248cb1f5d11SAlexander Motin 			hardfreq = hz;
2495b999a6bSDavide Italiano 		if (hardfreq > 1)
2505b999a6bSDavide Italiano 			event += tick_sbt * (hardfreq - 1);
251fd053faeSAlexander Motin 	}
2525b999a6bSDavide Italiano 	/* Handle callout events. */
2535b999a6bSDavide Italiano 	if (event > state->nextcall)
2545b999a6bSDavide Italiano 		event = state->nextcall;
255fd053faeSAlexander Motin 	if (!idle) { /* If CPU is active - handle other types of events. */
2565b999a6bSDavide Italiano 		if (event > state->nextstat)
2575b999a6bSDavide Italiano 			event = state->nextstat;
2585b999a6bSDavide Italiano 		if (profiling && event > state->nextprof)
2595b999a6bSDavide Italiano 			event = state->nextprof;
26043fe7d45SAlexander Motin 	}
2615b999a6bSDavide Italiano 	return (event);
26243fe7d45SAlexander Motin }
263a157e425SAlexander Motin 
264a157e425SAlexander Motin /*
265a157e425SAlexander Motin  * Schedule binuptime of the next event on all CPUs.
266a157e425SAlexander Motin  */
2675b999a6bSDavide Italiano static sbintime_t
268ebb3cb61SMark Johnston getnextevent(struct pcpu_state *state)
269a157e425SAlexander Motin {
2705b999a6bSDavide Italiano 	sbintime_t event;
271a157e425SAlexander Motin #ifdef SMP
272a157e425SAlexander Motin 	int	cpu;
273a157e425SAlexander Motin #endif
2745cc2d25aSMatt Macy #ifdef KTR
2755b999a6bSDavide Italiano 	int	c;
276a157e425SAlexander Motin 
2775cc2d25aSMatt Macy 	c = -1;
2785cc2d25aSMatt Macy #endif
2795b999a6bSDavide Italiano 	event = state->nextevent;
280fd053faeSAlexander Motin #ifdef SMP
2815b999a6bSDavide Italiano 	if ((timer->et_flags & ET_FLAGS_PERCPU) == 0) {
282a157e425SAlexander Motin 		CPU_FOREACH(cpu) {
283a157e425SAlexander Motin 			state = DPCPU_ID_PTR(cpu, timerstate);
2845b999a6bSDavide Italiano 			if (event > state->nextevent) {
2855b999a6bSDavide Italiano 				event = state->nextevent;
2865cc2d25aSMatt Macy #ifdef KTR
287a157e425SAlexander Motin 				c = cpu;
2885cc2d25aSMatt Macy #endif
28943fe7d45SAlexander Motin 			}
29043fe7d45SAlexander Motin 		}
2912d7d1642SGrzegorz Bernacki 	}
292a157e425SAlexander Motin #endif
2935b999a6bSDavide Italiano 	CTR4(KTR_SPARE2, "next at %d:    next %d.%08x by %d",
2945b999a6bSDavide Italiano 	    curcpu, (int)(event >> 32), (u_int)(event & 0xffffffff), c);
2955b999a6bSDavide Italiano 	return (event);
296a157e425SAlexander Motin }
297a157e425SAlexander Motin 
298a157e425SAlexander Motin /* Hardware timer callback function. */
299a157e425SAlexander Motin static void
300a157e425SAlexander Motin timercb(struct eventtimer *et, void *arg)
301a157e425SAlexander Motin {
3025b999a6bSDavide Italiano 	sbintime_t now;
3035b999a6bSDavide Italiano 	sbintime_t *next;
304a157e425SAlexander Motin 	struct pcpu_state *state;
305a157e425SAlexander Motin #ifdef SMP
306a157e425SAlexander Motin 	int cpu, bcast;
307a157e425SAlexander Motin #endif
308a157e425SAlexander Motin 
309a157e425SAlexander Motin 	/* Do not touch anything if somebody reconfiguring timers. */
310a157e425SAlexander Motin 	if (busy)
311a157e425SAlexander Motin 		return;
312a157e425SAlexander Motin 	/* Update present and next tick times. */
313a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
314a157e425SAlexander Motin 	if (et->et_flags & ET_FLAGS_PERCPU) {
315a157e425SAlexander Motin 		next = &state->nexttick;
316a157e425SAlexander Motin 	} else
317a157e425SAlexander Motin 		next = &nexttick;
3185b999a6bSDavide Italiano 	now = sbinuptime();
3195b999a6bSDavide Italiano 	if (periodic)
3205b999a6bSDavide Italiano 		*next = now + timerperiod;
3215b999a6bSDavide Italiano 	else
3225b999a6bSDavide Italiano 		*next = -1;	/* Next tick is not scheduled yet. */
323a157e425SAlexander Motin 	state->now = now;
3245b999a6bSDavide Italiano 	CTR3(KTR_SPARE2, "intr at %d:    now  %d.%08x",
3255b999a6bSDavide Italiano 	    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff));
326a157e425SAlexander Motin 
327a157e425SAlexander Motin #ifdef SMP
328fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP
329fdce57a0SJohn Baldwin 	MPASS(mp_ncpus == 1 || smp_started);
330fdce57a0SJohn Baldwin #endif
331a157e425SAlexander Motin 	/* Prepare broadcasting to other CPUs for non-per-CPU timers. */
332a157e425SAlexander Motin 	bcast = 0;
333fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP
334fdce57a0SJohn Baldwin 	if ((et->et_flags & ET_FLAGS_PERCPU) == 0) {
335fdce57a0SJohn Baldwin #else
336a157e425SAlexander Motin 	if ((et->et_flags & ET_FLAGS_PERCPU) == 0 && smp_started) {
337fdce57a0SJohn Baldwin #endif
338a157e425SAlexander Motin 		CPU_FOREACH(cpu) {
339a157e425SAlexander Motin 			state = DPCPU_ID_PTR(cpu, timerstate);
340a157e425SAlexander Motin 			ET_HW_LOCK(state);
341a157e425SAlexander Motin 			state->now = now;
3425b999a6bSDavide Italiano 			if (now >= state->nextevent) {
3435b999a6bSDavide Italiano 				state->nextevent += SBT_1S;
3448e860de4SAlexander Motin 				if (curcpu != cpu) {
345a157e425SAlexander Motin 					state->ipi = 1;
346a157e425SAlexander Motin 					bcast = 1;
347a157e425SAlexander Motin 				}
3488e860de4SAlexander Motin 			}
349a157e425SAlexander Motin 			ET_HW_UNLOCK(state);
350a157e425SAlexander Motin 		}
351a157e425SAlexander Motin 	}
352a157e425SAlexander Motin #endif
353a157e425SAlexander Motin 
354a157e425SAlexander Motin 	/* Handle events for this time on this CPU. */
3555b999a6bSDavide Italiano 	handleevents(now, 0);
356a157e425SAlexander Motin 
357a157e425SAlexander Motin #ifdef SMP
358a157e425SAlexander Motin 	/* Broadcast interrupt to other CPUs for non-per-CPU timers. */
359a157e425SAlexander Motin 	if (bcast) {
360a157e425SAlexander Motin 		CPU_FOREACH(cpu) {
361a157e425SAlexander Motin 			if (curcpu == cpu)
362a157e425SAlexander Motin 				continue;
363a157e425SAlexander Motin 			state = DPCPU_ID_PTR(cpu, timerstate);
364a157e425SAlexander Motin 			if (state->ipi) {
365a157e425SAlexander Motin 				state->ipi = 0;
366a157e425SAlexander Motin 				ipi_cpu(cpu, IPI_HARDCLOCK);
367a157e425SAlexander Motin 			}
368a157e425SAlexander Motin 		}
369a157e425SAlexander Motin 	}
370a157e425SAlexander Motin #endif
371a157e425SAlexander Motin }
372a157e425SAlexander Motin 
373a157e425SAlexander Motin /*
374a157e425SAlexander Motin  * Load new value into hardware timer.
375a157e425SAlexander Motin  */
376a157e425SAlexander Motin static void
3775b999a6bSDavide Italiano loadtimer(sbintime_t now, int start)
378a157e425SAlexander Motin {
379a157e425SAlexander Motin 	struct pcpu_state *state;
3805b999a6bSDavide Italiano 	sbintime_t new;
3815b999a6bSDavide Italiano 	sbintime_t *next;
382a157e425SAlexander Motin 	uint64_t tmp;
383a157e425SAlexander Motin 	int eq;
384a157e425SAlexander Motin 
385c70410e6SAlexander Motin 	state = DPCPU_PTR(timerstate);
386ebb3cb61SMark Johnston 	if (timer->et_flags & ET_FLAGS_PERCPU)
387c70410e6SAlexander Motin 		next = &state->nexttick;
388ebb3cb61SMark Johnston 	else
389c70410e6SAlexander Motin 		next = &nexttick;
390a157e425SAlexander Motin 	if (periodic) {
391a157e425SAlexander Motin 		if (start) {
392a157e425SAlexander Motin 			/*
393a157e425SAlexander Motin 			 * Try to start all periodic timers aligned
394a157e425SAlexander Motin 			 * to period to make events synchronous.
395a157e425SAlexander Motin 			 */
3965b999a6bSDavide Italiano 			tmp = now % timerperiod;
3975b999a6bSDavide Italiano 			new = timerperiod - tmp;
3985b999a6bSDavide Italiano 			if (new < tmp)		/* Left less then passed. */
3995b999a6bSDavide Italiano 				new += timerperiod;
400a157e425SAlexander Motin 			CTR5(KTR_SPARE2, "load p at %d:   now %d.%08x first in %d.%08x",
4015b999a6bSDavide Italiano 			    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff),
4025b999a6bSDavide Italiano 			    (int)(new >> 32), (u_int)(new & 0xffffffff));
4035b999a6bSDavide Italiano 			*next = new + now;
4045b999a6bSDavide Italiano 			et_start(timer, new, timerperiod);
405a157e425SAlexander Motin 		}
406a157e425SAlexander Motin 	} else {
407ebb3cb61SMark Johnston 		new = getnextevent(state);
4085b999a6bSDavide Italiano 		eq = (new == *next);
4095b999a6bSDavide Italiano 		CTR4(KTR_SPARE2, "load at %d:    next %d.%08x eq %d",
4105b999a6bSDavide Italiano 		    curcpu, (int)(new >> 32), (u_int)(new & 0xffffffff), eq);
411a157e425SAlexander Motin 		if (!eq) {
412a157e425SAlexander Motin 			*next = new;
4135b999a6bSDavide Italiano 			et_start(timer, new - now, 0);
414a157e425SAlexander Motin 		}
415a157e425SAlexander Motin 	}
416a157e425SAlexander Motin }
417a157e425SAlexander Motin 
418a157e425SAlexander Motin /*
419a157e425SAlexander Motin  * Prepare event timer parameters after configuration changes.
420a157e425SAlexander Motin  */
421a157e425SAlexander Motin static void
422a157e425SAlexander Motin setuptimer(void)
423a157e425SAlexander Motin {
424a157e425SAlexander Motin 	int freq;
425a157e425SAlexander Motin 
426a157e425SAlexander Motin 	if (periodic && (timer->et_flags & ET_FLAGS_PERIODIC) == 0)
427a157e425SAlexander Motin 		periodic = 0;
428a157e425SAlexander Motin 	else if (!periodic && (timer->et_flags & ET_FLAGS_ONESHOT) == 0)
429a157e425SAlexander Motin 		periodic = 1;
430dd9595e7SAlexander Motin 	singlemul = MIN(MAX(singlemul, 1), 20);
431a157e425SAlexander Motin 	freq = hz * singlemul;
432a157e425SAlexander Motin 	while (freq < (profiling ? profhz : stathz))
433a157e425SAlexander Motin 		freq += hz;
434a157e425SAlexander Motin 	freq = round_freq(timer, freq);
4355b999a6bSDavide Italiano 	timerperiod = SBT_1S / freq;
436a157e425SAlexander Motin }
43743fe7d45SAlexander Motin 
43843fe7d45SAlexander Motin /*
43943fe7d45SAlexander Motin  * Reconfigure specified per-CPU timer on other CPU. Called from IPI handler.
44043fe7d45SAlexander Motin  */
441a157e425SAlexander Motin static int
442a157e425SAlexander Motin doconfigtimer(void)
44343fe7d45SAlexander Motin {
4445b999a6bSDavide Italiano 	sbintime_t now;
445a157e425SAlexander Motin 	struct pcpu_state *state;
44643fe7d45SAlexander Motin 
447a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
448a157e425SAlexander Motin 	switch (atomic_load_acq_int(&state->action)) {
449a157e425SAlexander Motin 	case 1:
4505b999a6bSDavide Italiano 		now = sbinuptime();
451a157e425SAlexander Motin 		ET_HW_LOCK(state);
4525b999a6bSDavide Italiano 		loadtimer(now, 1);
453a157e425SAlexander Motin 		ET_HW_UNLOCK(state);
454a157e425SAlexander Motin 		state->handle = 0;
455a157e425SAlexander Motin 		atomic_store_rel_int(&state->action, 0);
456a157e425SAlexander Motin 		return (1);
457a157e425SAlexander Motin 	case 2:
458a157e425SAlexander Motin 		ET_HW_LOCK(state);
459a157e425SAlexander Motin 		et_stop(timer);
460a157e425SAlexander Motin 		ET_HW_UNLOCK(state);
461a157e425SAlexander Motin 		state->handle = 0;
462a157e425SAlexander Motin 		atomic_store_rel_int(&state->action, 0);
463a157e425SAlexander Motin 		return (1);
464a157e425SAlexander Motin 	}
465a157e425SAlexander Motin 	if (atomic_readandclear_int(&state->handle) && !busy) {
4665b999a6bSDavide Italiano 		now = sbinuptime();
4675b999a6bSDavide Italiano 		handleevents(now, 0);
46843fe7d45SAlexander Motin 		return (1);
46943fe7d45SAlexander Motin 	}
47043fe7d45SAlexander Motin 	return (0);
47143fe7d45SAlexander Motin }
47243fe7d45SAlexander Motin 
47343fe7d45SAlexander Motin /*
47443fe7d45SAlexander Motin  * Reconfigure specified timer.
47543fe7d45SAlexander Motin  * For per-CPU timers use IPI to make other CPUs to reconfigure.
47643fe7d45SAlexander Motin  */
47743fe7d45SAlexander Motin static void
478a157e425SAlexander Motin configtimer(int start)
47943fe7d45SAlexander Motin {
4805b999a6bSDavide Italiano 	sbintime_t now, next;
481a157e425SAlexander Motin 	struct pcpu_state *state;
48243fe7d45SAlexander Motin 	int cpu;
48343fe7d45SAlexander Motin 
484a157e425SAlexander Motin 	if (start) {
485a157e425SAlexander Motin 		setuptimer();
4865b999a6bSDavide Italiano 		now = sbinuptime();
4875b999a6bSDavide Italiano 	} else
4885b999a6bSDavide Italiano 		now = 0;
48943fe7d45SAlexander Motin 	critical_enter();
490a157e425SAlexander Motin 	ET_HW_LOCK(DPCPU_PTR(timerstate));
491a157e425SAlexander Motin 	if (start) {
492a157e425SAlexander Motin 		/* Initialize time machine parameters. */
4935b999a6bSDavide Italiano 		next = now + timerperiod;
494a157e425SAlexander Motin 		if (periodic)
495a157e425SAlexander Motin 			nexttick = next;
49643fe7d45SAlexander Motin 		else
4975b999a6bSDavide Italiano 			nexttick = -1;
498fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP
499fdce57a0SJohn Baldwin 		MPASS(mp_ncpus == 1 || smp_started);
500fdce57a0SJohn Baldwin #endif
501a157e425SAlexander Motin 		CPU_FOREACH(cpu) {
502a157e425SAlexander Motin 			state = DPCPU_ID_PTR(cpu, timerstate);
503a157e425SAlexander Motin 			state->now = now;
504fdce57a0SJohn Baldwin #ifndef EARLY_AP_STARTUP
5055b999a6bSDavide Italiano 			if (!smp_started && cpu != CPU_FIRST())
5064bc38a5aSDavide Italiano 				state->nextevent = SBT_MAX;
5075b999a6bSDavide Italiano 			else
508fdce57a0SJohn Baldwin #endif
509a157e425SAlexander Motin 				state->nextevent = next;
510a157e425SAlexander Motin 			if (periodic)
511a157e425SAlexander Motin 				state->nexttick = next;
512a157e425SAlexander Motin 			else
5135b999a6bSDavide Italiano 				state->nexttick = -1;
514a157e425SAlexander Motin 			state->nexthard = next;
515a157e425SAlexander Motin 			state->nextstat = next;
516a157e425SAlexander Motin 			state->nextprof = next;
5175b999a6bSDavide Italiano 			state->nextcall = next;
5185b999a6bSDavide Italiano 			state->nextcallopt = next;
519a157e425SAlexander Motin 			hardclock_sync(cpu);
520a157e425SAlexander Motin 		}
521a157e425SAlexander Motin 		busy = 0;
522a157e425SAlexander Motin 		/* Start global timer or per-CPU timer of this CPU. */
5235b999a6bSDavide Italiano 		loadtimer(now, 1);
524a157e425SAlexander Motin 	} else {
525a157e425SAlexander Motin 		busy = 1;
526a157e425SAlexander Motin 		/* Stop global timer or per-CPU timer of this CPU. */
527a157e425SAlexander Motin 		et_stop(timer);
528a157e425SAlexander Motin 	}
529a157e425SAlexander Motin 	ET_HW_UNLOCK(DPCPU_PTR(timerstate));
53043fe7d45SAlexander Motin #ifdef SMP
531fdce57a0SJohn Baldwin #ifdef EARLY_AP_STARTUP
532fdce57a0SJohn Baldwin 	/* If timer is global we are done. */
533fdce57a0SJohn Baldwin 	if ((timer->et_flags & ET_FLAGS_PERCPU) == 0) {
534fdce57a0SJohn Baldwin #else
535a157e425SAlexander Motin 	/* If timer is global or there is no other CPUs yet - we are done. */
536a157e425SAlexander Motin 	if ((timer->et_flags & ET_FLAGS_PERCPU) == 0 || !smp_started) {
537fdce57a0SJohn Baldwin #endif
53843fe7d45SAlexander Motin 		critical_exit();
53943fe7d45SAlexander Motin 		return;
54043fe7d45SAlexander Motin 	}
54143fe7d45SAlexander Motin 	/* Set reconfigure flags for other CPUs. */
54243fe7d45SAlexander Motin 	CPU_FOREACH(cpu) {
543a157e425SAlexander Motin 		state = DPCPU_ID_PTR(cpu, timerstate);
544a157e425SAlexander Motin 		atomic_store_rel_int(&state->action,
545a157e425SAlexander Motin 		    (cpu == curcpu) ? 0 : ( start ? 1 : 2));
54643fe7d45SAlexander Motin 	}
547a157e425SAlexander Motin 	/* Broadcast reconfigure IPI. */
548a157e425SAlexander Motin 	ipi_all_but_self(IPI_HARDCLOCK);
54943fe7d45SAlexander Motin 	/* Wait for reconfiguration completed. */
55043fe7d45SAlexander Motin restart:
55143fe7d45SAlexander Motin 	cpu_spinwait();
55243fe7d45SAlexander Motin 	CPU_FOREACH(cpu) {
55343fe7d45SAlexander Motin 		if (cpu == curcpu)
55443fe7d45SAlexander Motin 			continue;
555a157e425SAlexander Motin 		state = DPCPU_ID_PTR(cpu, timerstate);
556a157e425SAlexander Motin 		if (atomic_load_acq_int(&state->action))
55743fe7d45SAlexander Motin 			goto restart;
55843fe7d45SAlexander Motin 	}
55943fe7d45SAlexander Motin #endif
560a157e425SAlexander Motin 	critical_exit();
56143fe7d45SAlexander Motin }
56243fe7d45SAlexander Motin 
563a157e425SAlexander Motin /*
564a157e425SAlexander Motin  * Calculate nearest frequency supported by hardware timer.
565a157e425SAlexander Motin  */
56651636352SAlexander Motin static int
56751636352SAlexander Motin round_freq(struct eventtimer *et, int freq)
56851636352SAlexander Motin {
56951636352SAlexander Motin 	uint64_t div;
57051636352SAlexander Motin 
57151636352SAlexander Motin 	if (et->et_frequency != 0) {
572599cf0f1SAlexander Motin 		div = lmax((et->et_frequency + freq / 2) / freq, 1);
57351636352SAlexander Motin 		if (et->et_flags & ET_FLAGS_POW2DIV)
57451636352SAlexander Motin 			div = 1 << (flsl(div + div / 2) - 1);
57551636352SAlexander Motin 		freq = (et->et_frequency + div / 2) / div;
57651636352SAlexander Motin 	}
577fdc5dd2dSAlexander Motin 	if (et->et_min_period > SBT_1S)
578803a9b3eSAlexander Motin 		panic("Event timer \"%s\" doesn't support sub-second periods!",
579803a9b3eSAlexander Motin 		    et->et_name);
580fdc5dd2dSAlexander Motin 	else if (et->et_min_period != 0)
581fdc5dd2dSAlexander Motin 		freq = min(freq, SBT2FREQ(et->et_min_period));
582fdc5dd2dSAlexander Motin 	if (et->et_max_period < SBT_1S && et->et_max_period != 0)
583fdc5dd2dSAlexander Motin 		freq = max(freq, SBT2FREQ(et->et_max_period));
58451636352SAlexander Motin 	return (freq);
58551636352SAlexander Motin }
58651636352SAlexander Motin 
58743fe7d45SAlexander Motin /*
588a157e425SAlexander Motin  * Configure and start event timers (BSP part).
58943fe7d45SAlexander Motin  */
59043fe7d45SAlexander Motin void
59143fe7d45SAlexander Motin cpu_initclocks_bsp(void)
59243fe7d45SAlexander Motin {
593a157e425SAlexander Motin 	struct pcpu_state *state;
594a157e425SAlexander Motin 	int base, div, cpu;
59543fe7d45SAlexander Motin 
596a157e425SAlexander Motin 	mtx_init(&et_hw_mtx, "et_hw_mtx", NULL, MTX_SPIN);
597a157e425SAlexander Motin 	CPU_FOREACH(cpu) {
598a157e425SAlexander Motin 		state = DPCPU_ID_PTR(cpu, timerstate);
599a157e425SAlexander Motin 		mtx_init(&state->et_hw_mtx, "et_hw_mtx", NULL, MTX_SPIN);
6004bc38a5aSDavide Italiano 		state->nextcall = SBT_MAX;
6014bc38a5aSDavide Italiano 		state->nextcallopt = SBT_MAX;
602a157e425SAlexander Motin 	}
603afe41f2dSAlexander Motin 	periodic = want_periodic;
604a157e425SAlexander Motin 	/* Grab requested timer or the best of present. */
605a157e425SAlexander Motin 	if (timername[0])
606a157e425SAlexander Motin 		timer = et_find(timername, 0, 0);
607a157e425SAlexander Motin 	if (timer == NULL && periodic) {
608a157e425SAlexander Motin 		timer = et_find(NULL,
60943fe7d45SAlexander Motin 		    ET_FLAGS_PERIODIC, ET_FLAGS_PERIODIC);
610a157e425SAlexander Motin 	}
611a157e425SAlexander Motin 	if (timer == NULL) {
612a157e425SAlexander Motin 		timer = et_find(NULL,
613a157e425SAlexander Motin 		    ET_FLAGS_ONESHOT, ET_FLAGS_ONESHOT);
614a157e425SAlexander Motin 	}
615a157e425SAlexander Motin 	if (timer == NULL && !periodic) {
616a157e425SAlexander Motin 		timer = et_find(NULL,
617a157e425SAlexander Motin 		    ET_FLAGS_PERIODIC, ET_FLAGS_PERIODIC);
618a157e425SAlexander Motin 	}
619a157e425SAlexander Motin 	if (timer == NULL)
620a157e425SAlexander Motin 		panic("No usable event timer found!");
621a157e425SAlexander Motin 	et_init(timer, timercb, NULL, NULL);
622a157e425SAlexander Motin 
623a157e425SAlexander Motin 	/* Adapt to timer capabilities. */
624a157e425SAlexander Motin 	if (periodic && (timer->et_flags & ET_FLAGS_PERIODIC) == 0)
625a157e425SAlexander Motin 		periodic = 0;
626a157e425SAlexander Motin 	else if (!periodic && (timer->et_flags & ET_FLAGS_ONESHOT) == 0)
627a157e425SAlexander Motin 		periodic = 1;
628a157e425SAlexander Motin 	if (timer->et_flags & ET_FLAGS_C3STOP)
62992597e06SJohn Baldwin 		cpu_disable_c3_sleep++;
630a157e425SAlexander Motin 
63143fe7d45SAlexander Motin 	/*
63243fe7d45SAlexander Motin 	 * We honor the requested 'hz' value.
63343fe7d45SAlexander Motin 	 * We want to run stathz in the neighborhood of 128hz.
63443fe7d45SAlexander Motin 	 * We would like profhz to run as often as possible.
63543fe7d45SAlexander Motin 	 */
636dd9595e7SAlexander Motin 	if (singlemul <= 0 || singlemul > 20) {
63743fe7d45SAlexander Motin 		if (hz >= 1500 || (hz % 128) == 0)
63843fe7d45SAlexander Motin 			singlemul = 1;
63943fe7d45SAlexander Motin 		else if (hz >= 750)
64043fe7d45SAlexander Motin 			singlemul = 2;
64143fe7d45SAlexander Motin 		else
64243fe7d45SAlexander Motin 			singlemul = 4;
64343fe7d45SAlexander Motin 	}
644a157e425SAlexander Motin 	if (periodic) {
645a157e425SAlexander Motin 		base = round_freq(timer, hz * singlemul);
64651636352SAlexander Motin 		singlemul = max((base + hz / 2) / hz, 1);
64751636352SAlexander Motin 		hz = (base + singlemul / 2) / singlemul;
64851636352SAlexander Motin 		if (base <= 128)
64943fe7d45SAlexander Motin 			stathz = base;
65043fe7d45SAlexander Motin 		else {
65143fe7d45SAlexander Motin 			div = base / 128;
65251636352SAlexander Motin 			if (div >= singlemul && (div % singlemul) == 0)
65343fe7d45SAlexander Motin 				div++;
65443fe7d45SAlexander Motin 			stathz = base / div;
65543fe7d45SAlexander Motin 		}
65643fe7d45SAlexander Motin 		profhz = stathz;
65751636352SAlexander Motin 		while ((profhz + stathz) <= 128 * 64)
65843fe7d45SAlexander Motin 			profhz += stathz;
659a157e425SAlexander Motin 		profhz = round_freq(timer, profhz);
66043fe7d45SAlexander Motin 	} else {
661a157e425SAlexander Motin 		hz = round_freq(timer, hz);
662a157e425SAlexander Motin 		stathz = round_freq(timer, 127);
663a157e425SAlexander Motin 		profhz = round_freq(timer, stathz * 64);
66443fe7d45SAlexander Motin 	}
665599cf0f1SAlexander Motin 	tick = 1000000 / hz;
6665b999a6bSDavide Italiano 	tick_sbt = SBT_1S / hz;
6675b999a6bSDavide Italiano 	tick_bt = sbttobt(tick_sbt);
6685b999a6bSDavide Italiano 	statperiod = SBT_1S / stathz;
6695b999a6bSDavide Italiano 	profperiod = SBT_1S / profhz;
67043fe7d45SAlexander Motin 	ET_LOCK();
671a157e425SAlexander Motin 	configtimer(1);
67243fe7d45SAlexander Motin 	ET_UNLOCK();
67343fe7d45SAlexander Motin }
67443fe7d45SAlexander Motin 
675a157e425SAlexander Motin /*
676a157e425SAlexander Motin  * Start per-CPU event timers on APs.
677a157e425SAlexander Motin  */
67843fe7d45SAlexander Motin void
67943fe7d45SAlexander Motin cpu_initclocks_ap(void)
68043fe7d45SAlexander Motin {
681a157e425SAlexander Motin 	struct pcpu_state *state;
6825b999a6bSDavide Italiano 	struct thread *td;
68343fe7d45SAlexander Motin 
684a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
685a157e425SAlexander Motin 	ET_HW_LOCK(state);
686*a889a65bSMark Johnston 	state->now = sbinuptime();
687c70410e6SAlexander Motin 	hardclock_sync(curcpu);
6885b999a6bSDavide Italiano 	spinlock_enter();
689a157e425SAlexander Motin 	ET_HW_UNLOCK(state);
6905b999a6bSDavide Italiano 	td = curthread;
6915b999a6bSDavide Italiano 	td->td_intr_nesting_level++;
6925b999a6bSDavide Italiano 	handleevents(state->now, 2);
6935b999a6bSDavide Italiano 	td->td_intr_nesting_level--;
6945b999a6bSDavide Italiano 	spinlock_exit();
69543fe7d45SAlexander Motin }
69643fe7d45SAlexander Motin 
69727dca831SAndriy Gapon void
69827dca831SAndriy Gapon suspendclock(void)
69927dca831SAndriy Gapon {
70027dca831SAndriy Gapon 	ET_LOCK();
70127dca831SAndriy Gapon 	configtimer(0);
70227dca831SAndriy Gapon 	ET_UNLOCK();
70327dca831SAndriy Gapon }
70427dca831SAndriy Gapon 
70527dca831SAndriy Gapon void
70627dca831SAndriy Gapon resumeclock(void)
70727dca831SAndriy Gapon {
70827dca831SAndriy Gapon 	ET_LOCK();
70927dca831SAndriy Gapon 	configtimer(1);
71027dca831SAndriy Gapon 	ET_UNLOCK();
71127dca831SAndriy Gapon }
71227dca831SAndriy Gapon 
713a157e425SAlexander Motin /*
714a157e425SAlexander Motin  * Switch to profiling clock rates.
715a157e425SAlexander Motin  */
71643fe7d45SAlexander Motin void
71743fe7d45SAlexander Motin cpu_startprofclock(void)
71843fe7d45SAlexander Motin {
71943fe7d45SAlexander Motin 
72043fe7d45SAlexander Motin 	ET_LOCK();
7211af19ee4SAlexander Motin 	if (profiling == 0) {
722a157e425SAlexander Motin 		if (periodic) {
723a157e425SAlexander Motin 			configtimer(0);
724a157e425SAlexander Motin 			profiling = 1;
725a157e425SAlexander Motin 			configtimer(1);
726a157e425SAlexander Motin 		} else
727a157e425SAlexander Motin 			profiling = 1;
7281af19ee4SAlexander Motin 	} else
7291af19ee4SAlexander Motin 		profiling++;
73043fe7d45SAlexander Motin 	ET_UNLOCK();
73143fe7d45SAlexander Motin }
73243fe7d45SAlexander Motin 
733a157e425SAlexander Motin /*
734a157e425SAlexander Motin  * Switch to regular clock rates.
735a157e425SAlexander Motin  */
73643fe7d45SAlexander Motin void
73743fe7d45SAlexander Motin cpu_stopprofclock(void)
73843fe7d45SAlexander Motin {
73943fe7d45SAlexander Motin 
74043fe7d45SAlexander Motin 	ET_LOCK();
7411af19ee4SAlexander Motin 	if (profiling == 1) {
742a157e425SAlexander Motin 		if (periodic) {
743a157e425SAlexander Motin 			configtimer(0);
744a157e425SAlexander Motin 			profiling = 0;
745a157e425SAlexander Motin 			configtimer(1);
746a157e425SAlexander Motin 		} else
747a157e425SAlexander Motin 		profiling = 0;
7481af19ee4SAlexander Motin 	} else
7491af19ee4SAlexander Motin 		profiling--;
75043fe7d45SAlexander Motin 	ET_UNLOCK();
75143fe7d45SAlexander Motin }
75243fe7d45SAlexander Motin 
753a157e425SAlexander Motin /*
754a157e425SAlexander Motin  * Switch to idle mode (all ticks handled).
755a157e425SAlexander Motin  */
756acccf7d8SDavide Italiano sbintime_t
757a157e425SAlexander Motin cpu_idleclock(void)
758a157e425SAlexander Motin {
7595b999a6bSDavide Italiano 	sbintime_t now, t;
760a157e425SAlexander Motin 	struct pcpu_state *state;
761a157e425SAlexander Motin 
762a157e425SAlexander Motin 	if (idletick || busy ||
7639dfc483cSAlexander Motin 	    (periodic && (timer->et_flags & ET_FLAGS_PERCPU))
7649dfc483cSAlexander Motin #ifdef DEVICE_POLLING
7659dfc483cSAlexander Motin 	    || curcpu == CPU_FIRST()
7669dfc483cSAlexander Motin #endif
7679dfc483cSAlexander Motin 	    )
768acccf7d8SDavide Italiano 		return (-1);
769a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
770*a889a65bSMark Johnston 	ET_HW_LOCK(state);
771a157e425SAlexander Motin 	if (periodic)
772a157e425SAlexander Motin 		now = state->now;
773a157e425SAlexander Motin 	else
7745b999a6bSDavide Italiano 		now = sbinuptime();
7755b999a6bSDavide Italiano 	CTR3(KTR_SPARE2, "idle at %d:    now  %d.%08x",
7765b999a6bSDavide Italiano 	    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff));
777ebb3cb61SMark Johnston 	t = getnextcpuevent(state, 1);
778a157e425SAlexander Motin 	state->idle = 1;
779a157e425SAlexander Motin 	state->nextevent = t;
780a157e425SAlexander Motin 	if (!periodic)
7815b999a6bSDavide Italiano 		loadtimer(now, 0);
782a157e425SAlexander Motin 	ET_HW_UNLOCK(state);
7835b999a6bSDavide Italiano 	return (MAX(t - now, 0));
784a157e425SAlexander Motin }
785a157e425SAlexander Motin 
786a157e425SAlexander Motin /*
787a157e425SAlexander Motin  * Switch to active mode (skip empty ticks).
788a157e425SAlexander Motin  */
789a157e425SAlexander Motin void
790a157e425SAlexander Motin cpu_activeclock(void)
791a157e425SAlexander Motin {
7925b999a6bSDavide Italiano 	sbintime_t now;
793a157e425SAlexander Motin 	struct pcpu_state *state;
794a157e425SAlexander Motin 	struct thread *td;
795a157e425SAlexander Motin 
796a157e425SAlexander Motin 	state = DPCPU_PTR(timerstate);
797*a889a65bSMark Johnston 	if (atomic_load_int(&state->idle) == 0 || busy)
798a157e425SAlexander Motin 		return;
799*a889a65bSMark Johnston 	spinlock_enter();
800a157e425SAlexander Motin 	if (periodic)
801a157e425SAlexander Motin 		now = state->now;
802a157e425SAlexander Motin 	else
8035b999a6bSDavide Italiano 		now = sbinuptime();
8045b999a6bSDavide Italiano 	CTR3(KTR_SPARE2, "active at %d:  now  %d.%08x",
8055b999a6bSDavide Italiano 	    curcpu, (int)(now >> 32), (u_int)(now & 0xffffffff));
806a157e425SAlexander Motin 	td = curthread;
807a157e425SAlexander Motin 	td->td_intr_nesting_level++;
8085b999a6bSDavide Italiano 	handleevents(now, 1);
809a157e425SAlexander Motin 	td->td_intr_nesting_level--;
810a157e425SAlexander Motin 	spinlock_exit();
811a157e425SAlexander Motin }
812a157e425SAlexander Motin 
813cfc4b56bSIan Lepore /*
814cfc4b56bSIan Lepore  * Change the frequency of the given timer.  This changes et->et_frequency and
815cfc4b56bSIan Lepore  * if et is the active timer it reconfigures the timer on all CPUs.  This is
816cfc4b56bSIan Lepore  * intended to be a private interface for the use of et_change_frequency() only.
817cfc4b56bSIan Lepore  */
818cfc4b56bSIan Lepore void
819cfc4b56bSIan Lepore cpu_et_frequency(struct eventtimer *et, uint64_t newfreq)
820cfc4b56bSIan Lepore {
821cfc4b56bSIan Lepore 
822cfc4b56bSIan Lepore 	ET_LOCK();
823cfc4b56bSIan Lepore 	if (et == timer) {
824cfc4b56bSIan Lepore 		configtimer(0);
825cfc4b56bSIan Lepore 		et->et_frequency = newfreq;
826cfc4b56bSIan Lepore 		configtimer(1);
827cfc4b56bSIan Lepore 	} else
828cfc4b56bSIan Lepore 		et->et_frequency = newfreq;
829cfc4b56bSIan Lepore 	ET_UNLOCK();
830cfc4b56bSIan Lepore }
831cfc4b56bSIan Lepore 
8325b999a6bSDavide Italiano void
8335b999a6bSDavide Italiano cpu_new_callout(int cpu, sbintime_t bt, sbintime_t bt_opt)
834a157e425SAlexander Motin {
835a157e425SAlexander Motin 	struct pcpu_state *state;
836a157e425SAlexander Motin 
8375b999a6bSDavide Italiano 	/* Do not touch anything if somebody reconfiguring timers. */
8385b999a6bSDavide Italiano 	if (busy)
8395b999a6bSDavide Italiano 		return;
8405b999a6bSDavide Italiano 	CTR6(KTR_SPARE2, "new co at %d:    on %d at %d.%08x - %d.%08x",
8415b999a6bSDavide Italiano 	    curcpu, cpu, (int)(bt_opt >> 32), (u_int)(bt_opt & 0xffffffff),
8425b999a6bSDavide Italiano 	    (int)(bt >> 32), (u_int)(bt & 0xffffffff));
843efe67753SNathan Whitehorn 
844efe67753SNathan Whitehorn 	KASSERT(!CPU_ABSENT(cpu), ("Absent CPU %d", cpu));
845a157e425SAlexander Motin 	state = DPCPU_ID_PTR(cpu, timerstate);
846a157e425SAlexander Motin 	ET_HW_LOCK(state);
8475b999a6bSDavide Italiano 
8485b999a6bSDavide Italiano 	/*
8495b999a6bSDavide Italiano 	 * If there is callout time already set earlier -- do nothing.
8505b999a6bSDavide Italiano 	 * This check may appear redundant because we check already in
8515b999a6bSDavide Italiano 	 * callout_process() but this double check guarantees we're safe
8525b999a6bSDavide Italiano 	 * with respect to race conditions between interrupts execution
8535b999a6bSDavide Italiano 	 * and scheduling.
8545b999a6bSDavide Italiano 	 */
8555b999a6bSDavide Italiano 	state->nextcallopt = bt_opt;
8565b999a6bSDavide Italiano 	if (bt >= state->nextcall)
8575b999a6bSDavide Italiano 		goto done;
8585b999a6bSDavide Italiano 	state->nextcall = bt;
8595b999a6bSDavide Italiano 	/* If there is some other event set earlier -- do nothing. */
8605b999a6bSDavide Italiano 	if (bt >= state->nextevent)
8615b999a6bSDavide Italiano 		goto done;
8625b999a6bSDavide Italiano 	state->nextevent = bt;
8635b999a6bSDavide Italiano 	/* If timer is periodic -- there is nothing to reprogram. */
8645b999a6bSDavide Italiano 	if (periodic)
8655b999a6bSDavide Italiano 		goto done;
8665b999a6bSDavide Italiano 	/* If timer is global or of the current CPU -- reprogram it. */
8675b999a6bSDavide Italiano 	if ((timer->et_flags & ET_FLAGS_PERCPU) == 0 || cpu == curcpu) {
8685b999a6bSDavide Italiano 		loadtimer(sbinuptime(), 0);
8695b999a6bSDavide Italiano done:
870a157e425SAlexander Motin 		ET_HW_UNLOCK(state);
871a157e425SAlexander Motin 		return;
872a157e425SAlexander Motin 	}
8735b999a6bSDavide Italiano 	/* Otherwise make other CPU to reprogram it. */
874a157e425SAlexander Motin 	state->handle = 1;
8755b999a6bSDavide Italiano 	ET_HW_UNLOCK(state);
8765b999a6bSDavide Italiano #ifdef SMP
877a157e425SAlexander Motin 	ipi_cpu(cpu, IPI_HARDCLOCK);
878a157e425SAlexander Motin #endif
8795b999a6bSDavide Italiano }
880a157e425SAlexander Motin 
881a157e425SAlexander Motin /*
882a157e425SAlexander Motin  * Report or change the active event timers hardware.
883a157e425SAlexander Motin  */
88443fe7d45SAlexander Motin static int
885a157e425SAlexander Motin sysctl_kern_eventtimer_timer(SYSCTL_HANDLER_ARGS)
88643fe7d45SAlexander Motin {
88743fe7d45SAlexander Motin 	char buf[32];
88843fe7d45SAlexander Motin 	struct eventtimer *et;
88943fe7d45SAlexander Motin 	int error;
89043fe7d45SAlexander Motin 
89143fe7d45SAlexander Motin 	ET_LOCK();
892a157e425SAlexander Motin 	et = timer;
89343fe7d45SAlexander Motin 	snprintf(buf, sizeof(buf), "%s", et->et_name);
89443fe7d45SAlexander Motin 	ET_UNLOCK();
89543fe7d45SAlexander Motin 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
89643fe7d45SAlexander Motin 	ET_LOCK();
897a157e425SAlexander Motin 	et = timer;
89843fe7d45SAlexander Motin 	if (error != 0 || req->newptr == NULL ||
899a157e425SAlexander Motin 	    strcasecmp(buf, et->et_name) == 0) {
90043fe7d45SAlexander Motin 		ET_UNLOCK();
90143fe7d45SAlexander Motin 		return (error);
90243fe7d45SAlexander Motin 	}
903a157e425SAlexander Motin 	et = et_find(buf, 0, 0);
90443fe7d45SAlexander Motin 	if (et == NULL) {
90543fe7d45SAlexander Motin 		ET_UNLOCK();
90643fe7d45SAlexander Motin 		return (ENOENT);
90743fe7d45SAlexander Motin 	}
90843fe7d45SAlexander Motin 	configtimer(0);
909a157e425SAlexander Motin 	et_free(timer);
910a157e425SAlexander Motin 	if (et->et_flags & ET_FLAGS_C3STOP)
91192597e06SJohn Baldwin 		cpu_disable_c3_sleep++;
912a157e425SAlexander Motin 	if (timer->et_flags & ET_FLAGS_C3STOP)
91392597e06SJohn Baldwin 		cpu_disable_c3_sleep--;
914afe41f2dSAlexander Motin 	periodic = want_periodic;
915a157e425SAlexander Motin 	timer = et;
916a157e425SAlexander Motin 	et_init(timer, timercb, NULL, NULL);
91743fe7d45SAlexander Motin 	configtimer(1);
91843fe7d45SAlexander Motin 	ET_UNLOCK();
91943fe7d45SAlexander Motin 	return (error);
92043fe7d45SAlexander Motin }
921a157e425SAlexander Motin SYSCTL_PROC(_kern_eventtimer, OID_AUTO, timer,
92243fe7d45SAlexander Motin     CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
923dd9595e7SAlexander Motin     0, 0, sysctl_kern_eventtimer_timer, "A", "Chosen event timer");
924a157e425SAlexander Motin 
925a157e425SAlexander Motin /*
926a157e425SAlexander Motin  * Report or change the active event timer periodicity.
927a157e425SAlexander Motin  */
928a157e425SAlexander Motin static int
929a157e425SAlexander Motin sysctl_kern_eventtimer_periodic(SYSCTL_HANDLER_ARGS)
930a157e425SAlexander Motin {
931a157e425SAlexander Motin 	int error, val;
932a157e425SAlexander Motin 
933a157e425SAlexander Motin 	val = periodic;
934a157e425SAlexander Motin 	error = sysctl_handle_int(oidp, &val, 0, req);
935a157e425SAlexander Motin 	if (error != 0 || req->newptr == NULL)
936a157e425SAlexander Motin 		return (error);
937a157e425SAlexander Motin 	ET_LOCK();
938a157e425SAlexander Motin 	configtimer(0);
939afe41f2dSAlexander Motin 	periodic = want_periodic = val;
940a157e425SAlexander Motin 	configtimer(1);
941a157e425SAlexander Motin 	ET_UNLOCK();
942a157e425SAlexander Motin 	return (error);
943a157e425SAlexander Motin }
944a157e425SAlexander Motin SYSCTL_PROC(_kern_eventtimer, OID_AUTO, periodic,
945a157e425SAlexander Motin     CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE,
946dd9595e7SAlexander Motin     0, 0, sysctl_kern_eventtimer_periodic, "I", "Enable event timer periodic mode");
9476e3bf539SKonstantin Belousov 
9486e3bf539SKonstantin Belousov #include "opt_ddb.h"
9496e3bf539SKonstantin Belousov 
9506e3bf539SKonstantin Belousov #ifdef DDB
9516e3bf539SKonstantin Belousov #include <ddb/ddb.h>
9526e3bf539SKonstantin Belousov 
9536e3bf539SKonstantin Belousov DB_SHOW_COMMAND(clocksource, db_show_clocksource)
9546e3bf539SKonstantin Belousov {
9556e3bf539SKonstantin Belousov 	struct pcpu_state *st;
9566e3bf539SKonstantin Belousov 	int c;
9576e3bf539SKonstantin Belousov 
9586e3bf539SKonstantin Belousov 	CPU_FOREACH(c) {
9596e3bf539SKonstantin Belousov 		st = DPCPU_ID_PTR(c, timerstate);
9606e3bf539SKonstantin Belousov 		db_printf(
9616e3bf539SKonstantin Belousov 		    "CPU %2d: action %d handle %d  ipi %d idle %d\n"
9626e3bf539SKonstantin Belousov 		    "        now %#jx nevent %#jx (%jd)\n"
9636e3bf539SKonstantin Belousov 		    "        ntick %#jx (%jd) nhard %#jx (%jd)\n"
9646e3bf539SKonstantin Belousov 		    "        nstat %#jx (%jd) nprof %#jx (%jd)\n"
9656e3bf539SKonstantin Belousov 		    "        ncall %#jx (%jd) ncallopt %#jx (%jd)\n",
9666e3bf539SKonstantin Belousov 		    c, st->action, st->handle, st->ipi, st->idle,
9676e3bf539SKonstantin Belousov 		    (uintmax_t)st->now,
9686e3bf539SKonstantin Belousov 		    (uintmax_t)st->nextevent,
9696e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nextevent - st->now) / tick_sbt,
9706e3bf539SKonstantin Belousov 		    (uintmax_t)st->nexttick,
9716e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nexttick - st->now) / tick_sbt,
9726e3bf539SKonstantin Belousov 		    (uintmax_t)st->nexthard,
9736e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nexthard - st->now) / tick_sbt,
9746e3bf539SKonstantin Belousov 		    (uintmax_t)st->nextstat,
9756e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nextstat - st->now) / tick_sbt,
9766e3bf539SKonstantin Belousov 		    (uintmax_t)st->nextprof,
9776e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nextprof - st->now) / tick_sbt,
9786e3bf539SKonstantin Belousov 		    (uintmax_t)st->nextcall,
9796e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nextcall - st->now) / tick_sbt,
9806e3bf539SKonstantin Belousov 		    (uintmax_t)st->nextcallopt,
9816e3bf539SKonstantin Belousov 		    (uintmax_t)(st->nextcallopt - st->now) / tick_sbt);
9826e3bf539SKonstantin Belousov 	}
9836e3bf539SKonstantin Belousov }
9846e3bf539SKonstantin Belousov 
9856e3bf539SKonstantin Belousov #endif
986