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