Linux Audio

Check our new training course

Loading...
v4.17
 
   1/*
   2 *  linux/kernel/hrtimer.c
   3 *
   4 *  Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
   5 *  Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
   6 *  Copyright(C) 2006-2007  Timesys Corp., Thomas Gleixner
   7 *
   8 *  High-resolution kernel timers
   9 *
  10 *  In contrast to the low-resolution timeout API implemented in
  11 *  kernel/timer.c, hrtimers provide finer resolution and accuracy
  12 *  depending on system configuration and capabilities.
  13 *
  14 *  These timers are currently used for:
  15 *   - itimers
  16 *   - POSIX timers
  17 *   - nanosleep
  18 *   - precise in-kernel timing
  19 *
  20 *  Started by: Thomas Gleixner and Ingo Molnar
  21 *
  22 *  Credits:
  23 *	based on kernel/timer.c
  24 *
  25 *	Help, testing, suggestions, bugfixes, improvements were
  26 *	provided by:
  27 *
  28 *	George Anzinger, Andrew Morton, Steven Rostedt, Roman Zippel
  29 *	et. al.
  30 *
  31 *  For licencing details see kernel-base/COPYING
  32 */
  33
  34#include <linux/cpu.h>
  35#include <linux/export.h>
  36#include <linux/percpu.h>
  37#include <linux/hrtimer.h>
  38#include <linux/notifier.h>
  39#include <linux/syscalls.h>
  40#include <linux/interrupt.h>
  41#include <linux/tick.h>
  42#include <linux/seq_file.h>
  43#include <linux/err.h>
  44#include <linux/debugobjects.h>
  45#include <linux/sched/signal.h>
  46#include <linux/sched/sysctl.h>
  47#include <linux/sched/rt.h>
  48#include <linux/sched/deadline.h>
  49#include <linux/sched/nohz.h>
  50#include <linux/sched/debug.h>
 
  51#include <linux/timer.h>
  52#include <linux/freezer.h>
  53#include <linux/compat.h>
  54
  55#include <linux/uaccess.h>
  56
  57#include <trace/events/timer.h>
  58
  59#include "tick-internal.h"
  60
  61/*
  62 * Masks for selecting the soft and hard context timers from
  63 * cpu_base->active
  64 */
  65#define MASK_SHIFT		(HRTIMER_BASE_MONOTONIC_SOFT)
  66#define HRTIMER_ACTIVE_HARD	((1U << MASK_SHIFT) - 1)
  67#define HRTIMER_ACTIVE_SOFT	(HRTIMER_ACTIVE_HARD << MASK_SHIFT)
  68#define HRTIMER_ACTIVE_ALL	(HRTIMER_ACTIVE_SOFT | HRTIMER_ACTIVE_HARD)
  69
 
 
  70/*
  71 * The timer bases:
  72 *
  73 * There are more clockids than hrtimer bases. Thus, we index
  74 * into the timer bases by the hrtimer_base_type enum. When trying
  75 * to reach a base using a clockid, hrtimer_clockid_to_base()
  76 * is used to convert from clockid to the proper hrtimer_base_type.
  77 */
  78DEFINE_PER_CPU(struct hrtimer_cpu_base, hrtimer_bases) =
  79{
  80	.lock = __RAW_SPIN_LOCK_UNLOCKED(hrtimer_bases.lock),
  81	.clock_base =
  82	{
  83		{
  84			.index = HRTIMER_BASE_MONOTONIC,
  85			.clockid = CLOCK_MONOTONIC,
  86			.get_time = &ktime_get,
  87		},
  88		{
  89			.index = HRTIMER_BASE_REALTIME,
  90			.clockid = CLOCK_REALTIME,
  91			.get_time = &ktime_get_real,
  92		},
  93		{
  94			.index = HRTIMER_BASE_BOOTTIME,
  95			.clockid = CLOCK_BOOTTIME,
  96			.get_time = &ktime_get_boottime,
  97		},
  98		{
  99			.index = HRTIMER_BASE_TAI,
 100			.clockid = CLOCK_TAI,
 101			.get_time = &ktime_get_clocktai,
 102		},
 103		{
 104			.index = HRTIMER_BASE_MONOTONIC_SOFT,
 105			.clockid = CLOCK_MONOTONIC,
 106			.get_time = &ktime_get,
 107		},
 108		{
 109			.index = HRTIMER_BASE_REALTIME_SOFT,
 110			.clockid = CLOCK_REALTIME,
 111			.get_time = &ktime_get_real,
 112		},
 113		{
 114			.index = HRTIMER_BASE_BOOTTIME_SOFT,
 115			.clockid = CLOCK_BOOTTIME,
 116			.get_time = &ktime_get_boottime,
 117		},
 118		{
 119			.index = HRTIMER_BASE_TAI_SOFT,
 120			.clockid = CLOCK_TAI,
 121			.get_time = &ktime_get_clocktai,
 122		},
 123	}
 
 124};
 125
 126static const int hrtimer_clock_to_base_table[MAX_CLOCKS] = {
 127	/* Make sure we catch unsupported clockids */
 128	[0 ... MAX_CLOCKS - 1]	= HRTIMER_MAX_CLOCK_BASES,
 129
 130	[CLOCK_REALTIME]	= HRTIMER_BASE_REALTIME,
 131	[CLOCK_MONOTONIC]	= HRTIMER_BASE_MONOTONIC,
 132	[CLOCK_BOOTTIME]	= HRTIMER_BASE_BOOTTIME,
 133	[CLOCK_TAI]		= HRTIMER_BASE_TAI,
 134};
 135
 
 
 
 
 
 
 
 
 136/*
 137 * Functions and macros which are different for UP/SMP systems are kept in a
 138 * single place
 139 */
 140#ifdef CONFIG_SMP
 141
 142/*
 143 * We require the migration_base for lock_hrtimer_base()/switch_hrtimer_base()
 144 * such that hrtimer_callback_running() can unconditionally dereference
 145 * timer->base->cpu_base
 146 */
 147static struct hrtimer_cpu_base migration_cpu_base = {
 148	.clock_base = { { .cpu_base = &migration_cpu_base, }, },
 
 
 
 
 149};
 150
 151#define migration_base	migration_cpu_base.clock_base[0]
 152
 
 
 
 
 
 153/*
 154 * We are using hashed locking: holding per_cpu(hrtimer_bases)[n].lock
 155 * means that all timers which are tied to this base via timer->base are
 156 * locked, and the base itself is locked too.
 157 *
 158 * So __run_timers/migrate_timers can safely modify all timers which could
 159 * be found on the lists/queues.
 160 *
 161 * When the timer's base is locked, and the timer removed from list, it is
 162 * possible to set timer->base = &migration_base and drop the lock: the timer
 163 * remains locked.
 164 */
 165static
 166struct hrtimer_clock_base *lock_hrtimer_base(const struct hrtimer *timer,
 167					     unsigned long *flags)
 
 168{
 169	struct hrtimer_clock_base *base;
 170
 171	for (;;) {
 172		base = timer->base;
 173		if (likely(base != &migration_base)) {
 174			raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
 175			if (likely(base == timer->base))
 176				return base;
 177			/* The timer has migrated to another CPU: */
 178			raw_spin_unlock_irqrestore(&base->cpu_base->lock, *flags);
 179		}
 180		cpu_relax();
 181	}
 182}
 183
 184/*
 185 * We do not migrate the timer when it is expiring before the next
 186 * event on the target cpu. When high resolution is enabled, we cannot
 187 * reprogram the target cpu hardware and we would cause it to fire
 188 * late. To keep it simple, we handle the high resolution enabled and
 189 * disabled case similar.
 
 
 
 
 
 190 *
 191 * Called with cpu_base->lock of target cpu held.
 192 */
 193static int
 194hrtimer_check_target(struct hrtimer *timer, struct hrtimer_clock_base *new_base)
 
 195{
 196	ktime_t expires;
 197
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 198	expires = ktime_sub(hrtimer_get_expires(timer), new_base->offset);
 199	return expires < new_base->cpu_base->expires_next;
 
 200}
 201
 202static inline
 203struct hrtimer_cpu_base *get_target_base(struct hrtimer_cpu_base *base,
 204					 int pinned)
 205{
 
 
 
 
 
 
 206#if defined(CONFIG_SMP) && defined(CONFIG_NO_HZ_COMMON)
 207	if (static_branch_likely(&timers_migration_enabled) && !pinned)
 208		return &per_cpu(hrtimer_bases, get_nohz_timer_target());
 209#endif
 210	return base;
 211}
 212
 213/*
 214 * We switch the timer base to a power-optimized selected CPU target,
 215 * if:
 216 *	- NO_HZ_COMMON is enabled
 217 *	- timer migration is enabled
 218 *	- the timer callback is not running
 219 *	- the timer is not the first expiring timer on the new target
 220 *
 221 * If one of the above requirements is not fulfilled we move the timer
 222 * to the current CPU or leave it on the previously assigned CPU if
 223 * the timer callback is currently running.
 224 */
 225static inline struct hrtimer_clock_base *
 226switch_hrtimer_base(struct hrtimer *timer, struct hrtimer_clock_base *base,
 227		    int pinned)
 228{
 229	struct hrtimer_cpu_base *new_cpu_base, *this_cpu_base;
 230	struct hrtimer_clock_base *new_base;
 231	int basenum = base->index;
 232
 233	this_cpu_base = this_cpu_ptr(&hrtimer_bases);
 234	new_cpu_base = get_target_base(this_cpu_base, pinned);
 235again:
 236	new_base = &new_cpu_base->clock_base[basenum];
 237
 238	if (base != new_base) {
 239		/*
 240		 * We are trying to move timer to new_base.
 241		 * However we can't change timer's base while it is running,
 242		 * so we keep it on the same CPU. No hassle vs. reprogramming
 243		 * the event source in the high resolution case. The softirq
 244		 * code will take care of this when the timer function has
 245		 * completed. There is no conflict as we hold the lock until
 246		 * the timer is enqueued.
 247		 */
 248		if (unlikely(hrtimer_callback_running(timer)))
 249			return base;
 250
 251		/* See the comment in lock_hrtimer_base() */
 252		timer->base = &migration_base;
 253		raw_spin_unlock(&base->cpu_base->lock);
 254		raw_spin_lock(&new_base->cpu_base->lock);
 255
 256		if (new_cpu_base != this_cpu_base &&
 257		    hrtimer_check_target(timer, new_base)) {
 258			raw_spin_unlock(&new_base->cpu_base->lock);
 259			raw_spin_lock(&base->cpu_base->lock);
 260			new_cpu_base = this_cpu_base;
 261			timer->base = base;
 262			goto again;
 263		}
 264		timer->base = new_base;
 265	} else {
 266		if (new_cpu_base != this_cpu_base &&
 267		    hrtimer_check_target(timer, new_base)) {
 268			new_cpu_base = this_cpu_base;
 269			goto again;
 270		}
 271	}
 272	return new_base;
 273}
 274
 275#else /* CONFIG_SMP */
 276
 
 
 
 
 
 277static inline struct hrtimer_clock_base *
 278lock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
 
 279{
 280	struct hrtimer_clock_base *base = timer->base;
 281
 282	raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
 283
 284	return base;
 285}
 286
 287# define switch_hrtimer_base(t, b, p)	(b)
 288
 289#endif	/* !CONFIG_SMP */
 290
 291/*
 292 * Functions for the union type storage format of ktime_t which are
 293 * too large for inlining:
 294 */
 295#if BITS_PER_LONG < 64
 296/*
 297 * Divide a ktime value by a nanosecond value
 298 */
 299s64 __ktime_divns(const ktime_t kt, s64 div)
 300{
 301	int sft = 0;
 302	s64 dclc;
 303	u64 tmp;
 304
 305	dclc = ktime_to_ns(kt);
 306	tmp = dclc < 0 ? -dclc : dclc;
 307
 308	/* Make sure the divisor is less than 2^32: */
 309	while (div >> 32) {
 310		sft++;
 311		div >>= 1;
 312	}
 313	tmp >>= sft;
 314	do_div(tmp, (unsigned long) div);
 315	return dclc < 0 ? -tmp : tmp;
 316}
 317EXPORT_SYMBOL_GPL(__ktime_divns);
 318#endif /* BITS_PER_LONG >= 64 */
 319
 320/*
 321 * Add two ktime values and do a safety check for overflow:
 322 */
 323ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs)
 324{
 325	ktime_t res = ktime_add_unsafe(lhs, rhs);
 326
 327	/*
 328	 * We use KTIME_SEC_MAX here, the maximum timeout which we can
 329	 * return to user space in a timespec:
 330	 */
 331	if (res < 0 || res < lhs || res < rhs)
 332		res = ktime_set(KTIME_SEC_MAX, 0);
 333
 334	return res;
 335}
 336
 337EXPORT_SYMBOL_GPL(ktime_add_safe);
 338
 339#ifdef CONFIG_DEBUG_OBJECTS_TIMERS
 340
 341static struct debug_obj_descr hrtimer_debug_descr;
 342
 343static void *hrtimer_debug_hint(void *addr)
 344{
 345	return ((struct hrtimer *) addr)->function;
 346}
 347
 348/*
 349 * fixup_init is called when:
 350 * - an active object is initialized
 351 */
 352static bool hrtimer_fixup_init(void *addr, enum debug_obj_state state)
 353{
 354	struct hrtimer *timer = addr;
 355
 356	switch (state) {
 357	case ODEBUG_STATE_ACTIVE:
 358		hrtimer_cancel(timer);
 359		debug_object_init(timer, &hrtimer_debug_descr);
 360		return true;
 361	default:
 362		return false;
 363	}
 364}
 365
 366/*
 367 * fixup_activate is called when:
 368 * - an active object is activated
 369 * - an unknown non-static object is activated
 370 */
 371static bool hrtimer_fixup_activate(void *addr, enum debug_obj_state state)
 372{
 373	switch (state) {
 374	case ODEBUG_STATE_ACTIVE:
 375		WARN_ON(1);
 376
 377	default:
 378		return false;
 379	}
 380}
 381
 382/*
 383 * fixup_free is called when:
 384 * - an active object is freed
 385 */
 386static bool hrtimer_fixup_free(void *addr, enum debug_obj_state state)
 387{
 388	struct hrtimer *timer = addr;
 389
 390	switch (state) {
 391	case ODEBUG_STATE_ACTIVE:
 392		hrtimer_cancel(timer);
 393		debug_object_free(timer, &hrtimer_debug_descr);
 394		return true;
 395	default:
 396		return false;
 397	}
 398}
 399
 400static struct debug_obj_descr hrtimer_debug_descr = {
 401	.name		= "hrtimer",
 402	.debug_hint	= hrtimer_debug_hint,
 403	.fixup_init	= hrtimer_fixup_init,
 404	.fixup_activate	= hrtimer_fixup_activate,
 405	.fixup_free	= hrtimer_fixup_free,
 406};
 407
 408static inline void debug_hrtimer_init(struct hrtimer *timer)
 409{
 410	debug_object_init(timer, &hrtimer_debug_descr);
 411}
 412
 
 
 
 
 
 413static inline void debug_hrtimer_activate(struct hrtimer *timer,
 414					  enum hrtimer_mode mode)
 415{
 416	debug_object_activate(timer, &hrtimer_debug_descr);
 417}
 418
 419static inline void debug_hrtimer_deactivate(struct hrtimer *timer)
 420{
 421	debug_object_deactivate(timer, &hrtimer_debug_descr);
 422}
 423
 424static inline void debug_hrtimer_free(struct hrtimer *timer)
 425{
 426	debug_object_free(timer, &hrtimer_debug_descr);
 427}
 428
 429static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
 430			   enum hrtimer_mode mode);
 431
 432void hrtimer_init_on_stack(struct hrtimer *timer, clockid_t clock_id,
 433			   enum hrtimer_mode mode)
 434{
 435	debug_object_init_on_stack(timer, &hrtimer_debug_descr);
 436	__hrtimer_init(timer, clock_id, mode);
 437}
 438EXPORT_SYMBOL_GPL(hrtimer_init_on_stack);
 439
 440void destroy_hrtimer_on_stack(struct hrtimer *timer)
 441{
 442	debug_object_free(timer, &hrtimer_debug_descr);
 443}
 444EXPORT_SYMBOL_GPL(destroy_hrtimer_on_stack);
 445
 446#else
 447
 448static inline void debug_hrtimer_init(struct hrtimer *timer) { }
 
 449static inline void debug_hrtimer_activate(struct hrtimer *timer,
 450					  enum hrtimer_mode mode) { }
 451static inline void debug_hrtimer_deactivate(struct hrtimer *timer) { }
 452#endif
 453
 454static inline void
 455debug_init(struct hrtimer *timer, clockid_t clockid,
 456	   enum hrtimer_mode mode)
 457{
 458	debug_hrtimer_init(timer);
 459	trace_hrtimer_init(timer, clockid, mode);
 460}
 461
 
 
 
 
 
 
 
 462static inline void debug_activate(struct hrtimer *timer,
 463				  enum hrtimer_mode mode)
 464{
 465	debug_hrtimer_activate(timer, mode);
 466	trace_hrtimer_start(timer, mode);
 467}
 468
 469static inline void debug_deactivate(struct hrtimer *timer)
 470{
 471	debug_hrtimer_deactivate(timer);
 472	trace_hrtimer_cancel(timer);
 473}
 474
 475static struct hrtimer_clock_base *
 476__next_base(struct hrtimer_cpu_base *cpu_base, unsigned int *active)
 477{
 478	unsigned int idx;
 479
 480	if (!*active)
 481		return NULL;
 482
 483	idx = __ffs(*active);
 484	*active &= ~(1U << idx);
 485
 486	return &cpu_base->clock_base[idx];
 487}
 488
 489#define for_each_active_base(base, cpu_base, active)	\
 490	while ((base = __next_base((cpu_base), &(active))))
 491
 492static ktime_t __hrtimer_next_event_base(struct hrtimer_cpu_base *cpu_base,
 493					 const struct hrtimer *exclude,
 494					 unsigned int active,
 495					 ktime_t expires_next)
 496{
 497	struct hrtimer_clock_base *base;
 498	ktime_t expires;
 499
 500	for_each_active_base(base, cpu_base, active) {
 501		struct timerqueue_node *next;
 502		struct hrtimer *timer;
 503
 504		next = timerqueue_getnext(&base->active);
 505		timer = container_of(next, struct hrtimer, node);
 506		if (timer == exclude) {
 507			/* Get to the next timer in the queue. */
 508			next = timerqueue_iterate_next(next);
 509			if (!next)
 510				continue;
 511
 512			timer = container_of(next, struct hrtimer, node);
 513		}
 514		expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
 515		if (expires < expires_next) {
 516			expires_next = expires;
 517
 518			/* Skip cpu_base update if a timer is being excluded. */
 519			if (exclude)
 520				continue;
 521
 522			if (timer->is_soft)
 523				cpu_base->softirq_next_timer = timer;
 524			else
 525				cpu_base->next_timer = timer;
 526		}
 527	}
 528	/*
 529	 * clock_was_set() might have changed base->offset of any of
 530	 * the clock bases so the result might be negative. Fix it up
 531	 * to prevent a false positive in clockevents_program_event().
 532	 */
 533	if (expires_next < 0)
 534		expires_next = 0;
 535	return expires_next;
 536}
 537
 538/*
 539 * Recomputes cpu_base::*next_timer and returns the earliest expires_next but
 540 * does not set cpu_base::*expires_next, that is done by hrtimer_reprogram.
 
 
 
 541 *
 542 * When a softirq is pending, we can ignore the HRTIMER_ACTIVE_SOFT bases,
 543 * those timers will get run whenever the softirq gets handled, at the end of
 544 * hrtimer_run_softirq(), hrtimer_update_softirq_timer() will re-add these bases.
 545 *
 546 * Therefore softirq values are those from the HRTIMER_ACTIVE_SOFT clock bases.
 547 * The !softirq values are the minima across HRTIMER_ACTIVE_ALL, unless an actual
 548 * softirq is pending, in which case they're the minima of HRTIMER_ACTIVE_HARD.
 549 *
 550 * @active_mask must be one of:
 551 *  - HRTIMER_ACTIVE_ALL,
 552 *  - HRTIMER_ACTIVE_SOFT, or
 553 *  - HRTIMER_ACTIVE_HARD.
 554 */
 555static ktime_t
 556__hrtimer_get_next_event(struct hrtimer_cpu_base *cpu_base, unsigned int active_mask)
 557{
 558	unsigned int active;
 559	struct hrtimer *next_timer = NULL;
 560	ktime_t expires_next = KTIME_MAX;
 561
 562	if (!cpu_base->softirq_activated && (active_mask & HRTIMER_ACTIVE_SOFT)) {
 563		active = cpu_base->active_bases & HRTIMER_ACTIVE_SOFT;
 564		cpu_base->softirq_next_timer = NULL;
 565		expires_next = __hrtimer_next_event_base(cpu_base, NULL,
 566							 active, KTIME_MAX);
 567
 568		next_timer = cpu_base->softirq_next_timer;
 569	}
 570
 571	if (active_mask & HRTIMER_ACTIVE_HARD) {
 572		active = cpu_base->active_bases & HRTIMER_ACTIVE_HARD;
 573		cpu_base->next_timer = next_timer;
 574		expires_next = __hrtimer_next_event_base(cpu_base, NULL, active,
 575							 expires_next);
 576	}
 577
 578	return expires_next;
 579}
 580
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 581static inline ktime_t hrtimer_update_base(struct hrtimer_cpu_base *base)
 582{
 583	ktime_t *offs_real = &base->clock_base[HRTIMER_BASE_REALTIME].offset;
 584	ktime_t *offs_boot = &base->clock_base[HRTIMER_BASE_BOOTTIME].offset;
 585	ktime_t *offs_tai = &base->clock_base[HRTIMER_BASE_TAI].offset;
 586
 587	ktime_t now = ktime_get_update_offsets_now(&base->clock_was_set_seq,
 588					    offs_real, offs_boot, offs_tai);
 589
 590	base->clock_base[HRTIMER_BASE_REALTIME_SOFT].offset = *offs_real;
 591	base->clock_base[HRTIMER_BASE_BOOTTIME_SOFT].offset = *offs_boot;
 592	base->clock_base[HRTIMER_BASE_TAI_SOFT].offset = *offs_tai;
 593
 594	return now;
 595}
 596
 597/*
 598 * Is the high resolution mode active ?
 599 */
 600static inline int __hrtimer_hres_active(struct hrtimer_cpu_base *cpu_base)
 601{
 602	return IS_ENABLED(CONFIG_HIGH_RES_TIMERS) ?
 603		cpu_base->hres_active : 0;
 604}
 605
 606static inline int hrtimer_hres_active(void)
 607{
 608	return __hrtimer_hres_active(this_cpu_ptr(&hrtimer_bases));
 609}
 610
 611/*
 612 * Reprogram the event source with checking both queues for the
 613 * next event
 614 * Called with interrupts disabled and base->lock held
 615 */
 616static void
 617hrtimer_force_reprogram(struct hrtimer_cpu_base *cpu_base, int skip_equal)
 618{
 619	ktime_t expires_next;
 620
 621	/*
 622	 * Find the current next expiration time.
 623	 */
 624	expires_next = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_ALL);
 625
 626	if (cpu_base->next_timer && cpu_base->next_timer->is_soft) {
 627		/*
 628		 * When the softirq is activated, hrtimer has to be
 629		 * programmed with the first hard hrtimer because soft
 630		 * timer interrupt could occur too late.
 631		 */
 632		if (cpu_base->softirq_activated)
 633			expires_next = __hrtimer_get_next_event(cpu_base,
 634								HRTIMER_ACTIVE_HARD);
 635		else
 636			cpu_base->softirq_expires_next = expires_next;
 637	}
 638
 639	if (skip_equal && expires_next == cpu_base->expires_next)
 640		return;
 641
 642	cpu_base->expires_next = expires_next;
 643
 644	/*
 645	 * If hres is not active, hardware does not have to be
 646	 * reprogrammed yet.
 647	 *
 648	 * If a hang was detected in the last timer interrupt then we
 649	 * leave the hang delay active in the hardware. We want the
 650	 * system to make progress. That also prevents the following
 651	 * scenario:
 652	 * T1 expires 50ms from now
 653	 * T2 expires 5s from now
 654	 *
 655	 * T1 is removed, so this code is called and would reprogram
 656	 * the hardware to 5s from now. Any hrtimer_start after that
 657	 * will not reprogram the hardware due to hang_detected being
 658	 * set. So we'd effectivly block all timers until the T2 event
 659	 * fires.
 660	 */
 661	if (!__hrtimer_hres_active(cpu_base) || cpu_base->hang_detected)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 662		return;
 663
 664	tick_program_event(cpu_base->expires_next, 1);
 665}
 666
 667/* High resolution timer related functions */
 668#ifdef CONFIG_HIGH_RES_TIMERS
 669
 670/*
 671 * High resolution timer enabled ?
 672 */
 673static bool hrtimer_hres_enabled __read_mostly  = true;
 674unsigned int hrtimer_resolution __read_mostly = LOW_RES_NSEC;
 675EXPORT_SYMBOL_GPL(hrtimer_resolution);
 676
 677/*
 678 * Enable / Disable high resolution mode
 679 */
 680static int __init setup_hrtimer_hres(char *str)
 681{
 682	return (kstrtobool(str, &hrtimer_hres_enabled) == 0);
 683}
 684
 685__setup("highres=", setup_hrtimer_hres);
 686
 687/*
 688 * hrtimer_high_res_enabled - query, if the highres mode is enabled
 689 */
 690static inline int hrtimer_is_hres_enabled(void)
 691{
 692	return hrtimer_hres_enabled;
 693}
 694
 695/*
 696 * Retrigger next event is called after clock was set
 697 *
 698 * Called with interrupts disabled via on_each_cpu()
 699 */
 700static void retrigger_next_event(void *arg)
 701{
 702	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
 703
 704	if (!__hrtimer_hres_active(base))
 705		return;
 706
 707	raw_spin_lock(&base->lock);
 708	hrtimer_update_base(base);
 709	hrtimer_force_reprogram(base, 0);
 710	raw_spin_unlock(&base->lock);
 711}
 712
 713/*
 714 * Switch to high resolution mode
 715 */
 716static void hrtimer_switch_to_hres(void)
 717{
 718	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
 719
 720	if (tick_init_highres()) {
 721		printk(KERN_WARNING "Could not switch to high resolution "
 722				    "mode on CPU %d\n", base->cpu);
 723		return;
 724	}
 725	base->hres_active = 1;
 726	hrtimer_resolution = HIGH_RES_NSEC;
 727
 728	tick_setup_sched_timer();
 729	/* "Retrigger" the interrupt to get things going */
 730	retrigger_next_event(NULL);
 731}
 732
 733static void clock_was_set_work(struct work_struct *work)
 734{
 735	clock_was_set();
 736}
 737
 738static DECLARE_WORK(hrtimer_work, clock_was_set_work);
 
 739
 
 740/*
 741 * Called from timekeeping and resume code to reprogram the hrtimer
 742 * interrupt device on all cpus.
 
 
 
 
 
 
 
 
 
 743 */
 744void clock_was_set_delayed(void)
 745{
 746	schedule_work(&hrtimer_work);
 747}
 748
 749#else
 750
 751static inline int hrtimer_is_hres_enabled(void) { return 0; }
 752static inline void hrtimer_switch_to_hres(void) { }
 753static inline void retrigger_next_event(void *arg) { }
 
 
 
 
 
 
 
 
 
 
 
 
 
 754
 755#endif /* CONFIG_HIGH_RES_TIMERS */
 
 
 
 
 
 
 
 756
 757/*
 758 * When a timer is enqueued and expires earlier than the already enqueued
 759 * timers, we have to check, whether it expires earlier than the timer for
 760 * which the clock event device was armed.
 761 *
 762 * Called with interrupts disabled and base->cpu_base.lock held
 763 */
 764static void hrtimer_reprogram(struct hrtimer *timer, bool reprogram)
 765{
 766	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
 767	struct hrtimer_clock_base *base = timer->base;
 768	ktime_t expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
 769
 770	WARN_ON_ONCE(hrtimer_get_expires_tv64(timer) < 0);
 771
 772	/*
 773	 * CLOCK_REALTIME timer might be requested with an absolute
 774	 * expiry time which is less than base->offset. Set it to 0.
 775	 */
 776	if (expires < 0)
 777		expires = 0;
 778
 779	if (timer->is_soft) {
 780		/*
 781		 * soft hrtimer could be started on a remote CPU. In this
 782		 * case softirq_expires_next needs to be updated on the
 783		 * remote CPU. The soft hrtimer will not expire before the
 784		 * first hard hrtimer on the remote CPU -
 785		 * hrtimer_check_target() prevents this case.
 786		 */
 787		struct hrtimer_cpu_base *timer_cpu_base = base->cpu_base;
 788
 789		if (timer_cpu_base->softirq_activated)
 790			return;
 791
 792		if (!ktime_before(expires, timer_cpu_base->softirq_expires_next))
 793			return;
 794
 795		timer_cpu_base->softirq_next_timer = timer;
 796		timer_cpu_base->softirq_expires_next = expires;
 797
 798		if (!ktime_before(expires, timer_cpu_base->expires_next) ||
 799		    !reprogram)
 800			return;
 801	}
 802
 803	/*
 804	 * If the timer is not on the current cpu, we cannot reprogram
 805	 * the other cpus clock event device.
 806	 */
 807	if (base->cpu_base != cpu_base)
 808		return;
 809
 
 
 
 810	/*
 811	 * If the hrtimer interrupt is running, then it will
 812	 * reevaluate the clock bases and reprogram the clock event
 813	 * device. The callbacks are always executed in hard interrupt
 814	 * context so we don't need an extra check for a running
 815	 * callback.
 816	 */
 817	if (cpu_base->in_hrtirq)
 818		return;
 819
 820	if (expires >= cpu_base->expires_next)
 821		return;
 822
 823	/* Update the pointer to the next expiring timer */
 824	cpu_base->next_timer = timer;
 825	cpu_base->expires_next = expires;
 
 
 
 
 
 
 
 
 
 826
 827	/*
 828	 * If hres is not active, hardware does not have to be
 829	 * programmed yet.
 830	 *
 831	 * If a hang was detected in the last timer interrupt then we
 832	 * do not schedule a timer which is earlier than the expiry
 833	 * which we enforced in the hang detection. We want the system
 834	 * to make progress.
 
 835	 */
 836	if (!__hrtimer_hres_active(cpu_base) || cpu_base->hang_detected)
 837		return;
 
 
 
 
 
 
 
 838
 839	/*
 840	 * Program the timer hardware. We enforce the expiry for
 841	 * events which are already in the past.
 
 842	 */
 843	tick_program_event(expires, 1);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 844}
 845
 846/*
 847 * Clock realtime was set
 
 848 *
 849 * Change the offset of the realtime clock vs. the monotonic
 850 * clock.
 851 *
 852 * We might have to reprogram the high resolution timer interrupt. On
 853 * SMP we call the architecture specific code to retrigger _all_ high
 854 * resolution timer interrupts. On UP we just disable interrupts and
 855 * call the high resolution interrupt code.
 
 
 856 */
 857void clock_was_set(void)
 858{
 859#ifdef CONFIG_HIGH_RES_TIMERS
 860	/* Retrigger the CPU local events everywhere */
 861	on_each_cpu(retrigger_next_event, NULL, 1);
 862#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 863	timerfd_clock_was_set();
 864}
 865
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 866/*
 867 * During resume we might have to reprogram the high resolution timer
 868 * interrupt on all online CPUs.  However, all other CPUs will be
 869 * stopped with IRQs interrupts disabled so the clock_was_set() call
 870 * must be deferred.
 871 */
 872void hrtimers_resume(void)
 873{
 874	lockdep_assert_irqs_disabled();
 875	/* Retrigger on the local CPU */
 876	retrigger_next_event(NULL);
 877	/* And schedule a retrigger for all others */
 878	clock_was_set_delayed();
 879}
 880
 881/*
 882 * Counterpart to lock_hrtimer_base above:
 883 */
 884static inline
 885void unlock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
 
 886{
 887	raw_spin_unlock_irqrestore(&timer->base->cpu_base->lock, *flags);
 888}
 889
 890/**
 891 * hrtimer_forward - forward the timer expiry
 892 * @timer:	hrtimer to forward
 893 * @now:	forward past this time
 894 * @interval:	the interval to forward
 895 *
 896 * Forward the timer expiry so it will expire in the future.
 897 * Returns the number of overruns.
 898 *
 899 * Can be safely called from the callback function of @timer. If
 900 * called from other contexts @timer must neither be enqueued nor
 901 * running the callback and the caller needs to take care of
 902 * serialization.
 903 *
 904 * Note: This only updates the timer expiry value and does not requeue
 905 * the timer.
 
 
 
 
 
 906 */
 907u64 hrtimer_forward(struct hrtimer *timer, ktime_t now, ktime_t interval)
 908{
 909	u64 orun = 1;
 910	ktime_t delta;
 911
 912	delta = ktime_sub(now, hrtimer_get_expires(timer));
 913
 914	if (delta < 0)
 915		return 0;
 916
 917	if (WARN_ON(timer->state & HRTIMER_STATE_ENQUEUED))
 918		return 0;
 919
 920	if (interval < hrtimer_resolution)
 921		interval = hrtimer_resolution;
 922
 923	if (unlikely(delta >= interval)) {
 924		s64 incr = ktime_to_ns(interval);
 925
 926		orun = ktime_divns(delta, incr);
 927		hrtimer_add_expires_ns(timer, incr * orun);
 928		if (hrtimer_get_expires_tv64(timer) > now)
 929			return orun;
 930		/*
 931		 * This (and the ktime_add() below) is the
 932		 * correction for exact:
 933		 */
 934		orun++;
 935	}
 936	hrtimer_add_expires(timer, interval);
 937
 938	return orun;
 939}
 940EXPORT_SYMBOL_GPL(hrtimer_forward);
 941
 942/*
 943 * enqueue_hrtimer - internal function to (re)start a timer
 944 *
 945 * The timer is inserted in expiry order. Insertion into the
 946 * red black tree is O(log(n)). Must hold the base lock.
 947 *
 948 * Returns 1 when the new timer is the leftmost timer in the tree.
 949 */
 950static int enqueue_hrtimer(struct hrtimer *timer,
 951			   struct hrtimer_clock_base *base,
 952			   enum hrtimer_mode mode)
 953{
 954	debug_activate(timer, mode);
 
 955
 956	base->cpu_base->active_bases |= 1 << base->index;
 957
 958	timer->state = HRTIMER_STATE_ENQUEUED;
 
 959
 960	return timerqueue_add(&base->active, &timer->node);
 961}
 962
 963/*
 964 * __remove_hrtimer - internal function to remove a timer
 965 *
 966 * Caller must hold the base lock.
 967 *
 968 * High resolution timer mode reprograms the clock event device when the
 969 * timer is the one which expires next. The caller can disable this by setting
 970 * reprogram to zero. This is useful, when the context does a reprogramming
 971 * anyway (e.g. timer interrupt)
 972 */
 973static void __remove_hrtimer(struct hrtimer *timer,
 974			     struct hrtimer_clock_base *base,
 975			     u8 newstate, int reprogram)
 976{
 977	struct hrtimer_cpu_base *cpu_base = base->cpu_base;
 978	u8 state = timer->state;
 979
 980	timer->state = newstate;
 
 981	if (!(state & HRTIMER_STATE_ENQUEUED))
 982		return;
 983
 984	if (!timerqueue_del(&base->active, &timer->node))
 985		cpu_base->active_bases &= ~(1 << base->index);
 986
 987	/*
 988	 * Note: If reprogram is false we do not update
 989	 * cpu_base->next_timer. This happens when we remove the first
 990	 * timer on a remote cpu. No harm as we never dereference
 991	 * cpu_base->next_timer. So the worst thing what can happen is
 992	 * an superflous call to hrtimer_force_reprogram() on the
 993	 * remote cpu later on if the same timer gets enqueued again.
 994	 */
 995	if (reprogram && timer == cpu_base->next_timer)
 996		hrtimer_force_reprogram(cpu_base, 1);
 997}
 998
 999/*
1000 * remove hrtimer, called with base lock held
1001 */
1002static inline int
1003remove_hrtimer(struct hrtimer *timer, struct hrtimer_clock_base *base, bool restart)
 
1004{
1005	if (hrtimer_is_queued(timer)) {
1006		u8 state = timer->state;
1007		int reprogram;
 
1008
1009		/*
1010		 * Remove the timer and force reprogramming when high
1011		 * resolution mode is active and the timer is on the current
1012		 * CPU. If we remove a timer on another CPU, reprogramming is
1013		 * skipped. The interrupt event on this CPU is fired and
1014		 * reprogramming happens in the interrupt handler. This is a
1015		 * rare case and less expensive than a smp call.
1016		 */
1017		debug_deactivate(timer);
1018		reprogram = base->cpu_base == this_cpu_ptr(&hrtimer_bases);
1019
 
 
 
 
 
 
1020		if (!restart)
1021			state = HRTIMER_STATE_INACTIVE;
 
 
1022
1023		__remove_hrtimer(timer, base, state, reprogram);
1024		return 1;
1025	}
1026	return 0;
1027}
1028
1029static inline ktime_t hrtimer_update_lowres(struct hrtimer *timer, ktime_t tim,
1030					    const enum hrtimer_mode mode)
1031{
1032#ifdef CONFIG_TIME_LOW_RES
1033	/*
1034	 * CONFIG_TIME_LOW_RES indicates that the system has no way to return
1035	 * granular time values. For relative timers we add hrtimer_resolution
1036	 * (i.e. one jiffie) to prevent short timeouts.
1037	 */
1038	timer->is_rel = mode & HRTIMER_MODE_REL;
1039	if (timer->is_rel)
1040		tim = ktime_add_safe(tim, hrtimer_resolution);
1041#endif
1042	return tim;
1043}
1044
1045static void
1046hrtimer_update_softirq_timer(struct hrtimer_cpu_base *cpu_base, bool reprogram)
1047{
1048	ktime_t expires;
1049
1050	/*
1051	 * Find the next SOFT expiration.
1052	 */
1053	expires = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_SOFT);
1054
1055	/*
1056	 * reprogramming needs to be triggered, even if the next soft
1057	 * hrtimer expires at the same time than the next hard
1058	 * hrtimer. cpu_base->softirq_expires_next needs to be updated!
1059	 */
1060	if (expires == KTIME_MAX)
1061		return;
1062
1063	/*
1064	 * cpu_base->*next_timer is recomputed by __hrtimer_get_next_event()
1065	 * cpu_base->*expires_next is only set by hrtimer_reprogram()
1066	 */
1067	hrtimer_reprogram(cpu_base->softirq_next_timer, reprogram);
1068}
1069
1070static int __hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
1071				    u64 delta_ns, const enum hrtimer_mode mode,
1072				    struct hrtimer_clock_base *base)
1073{
 
1074	struct hrtimer_clock_base *new_base;
 
1075
1076	/* Remove an active timer from the queue: */
1077	remove_hrtimer(timer, base, true);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1078
1079	if (mode & HRTIMER_MODE_REL)
1080		tim = ktime_add_safe(tim, base->get_time());
1081
1082	tim = hrtimer_update_lowres(timer, tim, mode);
1083
1084	hrtimer_set_expires_range_ns(timer, tim, delta_ns);
1085
1086	/* Switch the timer base, if necessary: */
1087	new_base = switch_hrtimer_base(timer, base, mode & HRTIMER_MODE_PINNED);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1088
1089	return enqueue_hrtimer(timer, new_base, mode);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1090}
1091
1092/**
1093 * hrtimer_start_range_ns - (re)start an hrtimer
1094 * @timer:	the timer to be added
1095 * @tim:	expiry time
1096 * @delta_ns:	"slack" range for the timer
1097 * @mode:	timer mode: absolute (HRTIMER_MODE_ABS) or
1098 *		relative (HRTIMER_MODE_REL), and pinned (HRTIMER_MODE_PINNED);
1099 *		softirq based mode is considered for debug purpose only!
1100 */
1101void hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
1102			    u64 delta_ns, const enum hrtimer_mode mode)
1103{
1104	struct hrtimer_clock_base *base;
1105	unsigned long flags;
1106
 
 
1107	/*
1108	 * Check whether the HRTIMER_MODE_SOFT bit and hrtimer.is_soft
1109	 * match.
 
1110	 */
1111	WARN_ON_ONCE(!(mode & HRTIMER_MODE_SOFT) ^ !timer->is_soft);
 
 
 
1112
1113	base = lock_hrtimer_base(timer, &flags);
1114
1115	if (__hrtimer_start_range_ns(timer, tim, delta_ns, mode, base))
1116		hrtimer_reprogram(timer, true);
1117
1118	unlock_hrtimer_base(timer, &flags);
1119}
1120EXPORT_SYMBOL_GPL(hrtimer_start_range_ns);
1121
1122/**
1123 * hrtimer_try_to_cancel - try to deactivate a timer
1124 * @timer:	hrtimer to stop
1125 *
1126 * Returns:
1127 *  0 when the timer was not active
1128 *  1 when the timer was active
1129 * -1 when the timer is currently executing the callback function and
 
1130 *    cannot be stopped
1131 */
1132int hrtimer_try_to_cancel(struct hrtimer *timer)
1133{
1134	struct hrtimer_clock_base *base;
1135	unsigned long flags;
1136	int ret = -1;
1137
1138	/*
1139	 * Check lockless first. If the timer is not active (neither
1140	 * enqueued nor running the callback, nothing to do here.  The
1141	 * base lock does not serialize against a concurrent enqueue,
1142	 * so we can avoid taking it.
1143	 */
1144	if (!hrtimer_active(timer))
1145		return 0;
1146
1147	base = lock_hrtimer_base(timer, &flags);
1148
1149	if (!hrtimer_callback_running(timer))
1150		ret = remove_hrtimer(timer, base, false);
1151
1152	unlock_hrtimer_base(timer, &flags);
1153
1154	return ret;
1155
1156}
1157EXPORT_SYMBOL_GPL(hrtimer_try_to_cancel);
1158
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1159/**
1160 * hrtimer_cancel - cancel a timer and wait for the handler to finish.
1161 * @timer:	the timer to be cancelled
1162 *
1163 * Returns:
1164 *  0 when the timer was not active
1165 *  1 when the timer was active
1166 */
1167int hrtimer_cancel(struct hrtimer *timer)
1168{
1169	for (;;) {
1170		int ret = hrtimer_try_to_cancel(timer);
1171
1172		if (ret >= 0)
1173			return ret;
1174		cpu_relax();
1175	}
 
 
 
1176}
1177EXPORT_SYMBOL_GPL(hrtimer_cancel);
1178
1179/**
1180 * hrtimer_get_remaining - get remaining time for the timer
1181 * @timer:	the timer to read
1182 * @adjust:	adjust relative timers when CONFIG_TIME_LOW_RES=y
1183 */
1184ktime_t __hrtimer_get_remaining(const struct hrtimer *timer, bool adjust)
1185{
1186	unsigned long flags;
1187	ktime_t rem;
1188
1189	lock_hrtimer_base(timer, &flags);
1190	if (IS_ENABLED(CONFIG_TIME_LOW_RES) && adjust)
1191		rem = hrtimer_expires_remaining_adjusted(timer);
1192	else
1193		rem = hrtimer_expires_remaining(timer);
1194	unlock_hrtimer_base(timer, &flags);
1195
1196	return rem;
1197}
1198EXPORT_SYMBOL_GPL(__hrtimer_get_remaining);
1199
1200#ifdef CONFIG_NO_HZ_COMMON
1201/**
1202 * hrtimer_get_next_event - get the time until next expiry event
1203 *
1204 * Returns the next expiry time or KTIME_MAX if no timer is pending.
1205 */
1206u64 hrtimer_get_next_event(void)
1207{
1208	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1209	u64 expires = KTIME_MAX;
1210	unsigned long flags;
1211
1212	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1213
1214	if (!__hrtimer_hres_active(cpu_base))
1215		expires = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_ALL);
1216
1217	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1218
1219	return expires;
1220}
1221
1222/**
1223 * hrtimer_next_event_without - time until next expiry event w/o one timer
1224 * @exclude:	timer to exclude
1225 *
1226 * Returns the next expiry time over all timers except for the @exclude one or
1227 * KTIME_MAX if none of them is pending.
1228 */
1229u64 hrtimer_next_event_without(const struct hrtimer *exclude)
1230{
1231	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1232	u64 expires = KTIME_MAX;
1233	unsigned long flags;
1234
1235	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1236
1237	if (__hrtimer_hres_active(cpu_base)) {
1238		unsigned int active;
1239
1240		if (!cpu_base->softirq_activated) {
1241			active = cpu_base->active_bases & HRTIMER_ACTIVE_SOFT;
1242			expires = __hrtimer_next_event_base(cpu_base, exclude,
1243							    active, KTIME_MAX);
1244		}
1245		active = cpu_base->active_bases & HRTIMER_ACTIVE_HARD;
1246		expires = __hrtimer_next_event_base(cpu_base, exclude, active,
1247						    expires);
1248	}
1249
1250	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1251
1252	return expires;
1253}
1254#endif
1255
1256static inline int hrtimer_clockid_to_base(clockid_t clock_id)
1257{
1258	if (likely(clock_id < MAX_CLOCKS)) {
1259		int base = hrtimer_clock_to_base_table[clock_id];
1260
1261		if (likely(base != HRTIMER_MAX_CLOCK_BASES))
1262			return base;
1263	}
1264	WARN(1, "Invalid clockid %d. Using MONOTONIC\n", clock_id);
1265	return HRTIMER_BASE_MONOTONIC;
1266}
1267
 
 
 
 
 
1268static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
1269			   enum hrtimer_mode mode)
1270{
1271	bool softtimer = !!(mode & HRTIMER_MODE_SOFT);
1272	int base = softtimer ? HRTIMER_MAX_CLOCK_BASES / 2 : 0;
1273	struct hrtimer_cpu_base *cpu_base;
 
 
 
 
 
 
 
 
 
 
1274
1275	memset(timer, 0, sizeof(struct hrtimer));
1276
1277	cpu_base = raw_cpu_ptr(&hrtimer_bases);
1278
1279	/*
1280	 * POSIX magic: Relative CLOCK_REALTIME timers are not affected by
1281	 * clock modifications, so they needs to become CLOCK_MONOTONIC to
1282	 * ensure POSIX compliance.
1283	 */
1284	if (clock_id == CLOCK_REALTIME && mode & HRTIMER_MODE_REL)
1285		clock_id = CLOCK_MONOTONIC;
1286
 
1287	base += hrtimer_clockid_to_base(clock_id);
1288	timer->is_soft = softtimer;
 
1289	timer->base = &cpu_base->clock_base[base];
1290	timerqueue_init(&timer->node);
1291}
1292
 
 
 
 
 
 
 
 
 
 
 
 
1293/**
1294 * hrtimer_init - initialize a timer to the given clock
1295 * @timer:	the timer to be initialized
1296 * @clock_id:	the clock to be used
1297 * @mode:       The modes which are relevant for intitialization:
1298 *              HRTIMER_MODE_ABS, HRTIMER_MODE_REL, HRTIMER_MODE_ABS_SOFT,
1299 *              HRTIMER_MODE_REL_SOFT
1300 *
1301 *              The PINNED variants of the above can be handed in,
1302 *              but the PINNED bit is ignored as pinning happens
1303 *              when the hrtimer is started
1304 */
1305void hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
1306		  enum hrtimer_mode mode)
1307{
1308	debug_init(timer, clock_id, mode);
1309	__hrtimer_init(timer, clock_id, mode);
1310}
1311EXPORT_SYMBOL_GPL(hrtimer_init);
1312
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1313/*
1314 * A timer is active, when it is enqueued into the rbtree or the
1315 * callback function is running or it's in the state of being migrated
1316 * to another cpu.
1317 *
1318 * It is important for this function to not return a false negative.
1319 */
1320bool hrtimer_active(const struct hrtimer *timer)
1321{
1322	struct hrtimer_clock_base *base;
1323	unsigned int seq;
1324
1325	do {
1326		base = READ_ONCE(timer->base);
1327		seq = raw_read_seqcount_begin(&base->seq);
1328
1329		if (timer->state != HRTIMER_STATE_INACTIVE ||
1330		    base->running == timer)
1331			return true;
1332
1333	} while (read_seqcount_retry(&base->seq, seq) ||
1334		 base != READ_ONCE(timer->base));
1335
1336	return false;
1337}
1338EXPORT_SYMBOL_GPL(hrtimer_active);
1339
1340/*
1341 * The write_seqcount_barrier()s in __run_hrtimer() split the thing into 3
1342 * distinct sections:
1343 *
1344 *  - queued:	the timer is queued
1345 *  - callback:	the timer is being ran
1346 *  - post:	the timer is inactive or (re)queued
1347 *
1348 * On the read side we ensure we observe timer->state and cpu_base->running
1349 * from the same section, if anything changed while we looked at it, we retry.
1350 * This includes timer->base changing because sequence numbers alone are
1351 * insufficient for that.
1352 *
1353 * The sequence numbers are required because otherwise we could still observe
1354 * a false negative if the read side got smeared over multiple consequtive
1355 * __run_hrtimer() invocations.
1356 */
1357
1358static void __run_hrtimer(struct hrtimer_cpu_base *cpu_base,
1359			  struct hrtimer_clock_base *base,
1360			  struct hrtimer *timer, ktime_t *now,
1361			  unsigned long flags)
1362{
1363	enum hrtimer_restart (*fn)(struct hrtimer *);
 
1364	int restart;
1365
1366	lockdep_assert_held(&cpu_base->lock);
1367
1368	debug_deactivate(timer);
1369	base->running = timer;
1370
1371	/*
1372	 * Separate the ->running assignment from the ->state assignment.
1373	 *
1374	 * As with a regular write barrier, this ensures the read side in
1375	 * hrtimer_active() cannot observe base->running == NULL &&
1376	 * timer->state == INACTIVE.
1377	 */
1378	raw_write_seqcount_barrier(&base->seq);
1379
1380	__remove_hrtimer(timer, base, HRTIMER_STATE_INACTIVE, 0);
1381	fn = timer->function;
1382
1383	/*
1384	 * Clear the 'is relative' flag for the TIME_LOW_RES case. If the
1385	 * timer is restarted with a period then it becomes an absolute
1386	 * timer. If its not restarted it does not matter.
1387	 */
1388	if (IS_ENABLED(CONFIG_TIME_LOW_RES))
1389		timer->is_rel = false;
1390
1391	/*
1392	 * The timer is marked as running in the CPU base, so it is
1393	 * protected against migration to a different CPU even if the lock
1394	 * is dropped.
1395	 */
1396	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1397	trace_hrtimer_expire_entry(timer, now);
 
 
1398	restart = fn(timer);
 
 
1399	trace_hrtimer_expire_exit(timer);
1400	raw_spin_lock_irq(&cpu_base->lock);
1401
1402	/*
1403	 * Note: We clear the running state after enqueue_hrtimer and
1404	 * we do not reprogram the event hardware. Happens either in
1405	 * hrtimer_start_range_ns() or in hrtimer_interrupt()
1406	 *
1407	 * Note: Because we dropped the cpu_base->lock above,
1408	 * hrtimer_start_range_ns() can have popped in and enqueued the timer
1409	 * for us already.
1410	 */
1411	if (restart != HRTIMER_NORESTART &&
1412	    !(timer->state & HRTIMER_STATE_ENQUEUED))
1413		enqueue_hrtimer(timer, base, HRTIMER_MODE_ABS);
1414
1415	/*
1416	 * Separate the ->running assignment from the ->state assignment.
1417	 *
1418	 * As with a regular write barrier, this ensures the read side in
1419	 * hrtimer_active() cannot observe base->running.timer == NULL &&
1420	 * timer->state == INACTIVE.
1421	 */
1422	raw_write_seqcount_barrier(&base->seq);
1423
1424	WARN_ON_ONCE(base->running != timer);
1425	base->running = NULL;
1426}
1427
1428static void __hrtimer_run_queues(struct hrtimer_cpu_base *cpu_base, ktime_t now,
1429				 unsigned long flags, unsigned int active_mask)
1430{
1431	struct hrtimer_clock_base *base;
1432	unsigned int active = cpu_base->active_bases & active_mask;
1433
1434	for_each_active_base(base, cpu_base, active) {
1435		struct timerqueue_node *node;
1436		ktime_t basenow;
1437
1438		basenow = ktime_add(now, base->offset);
1439
1440		while ((node = timerqueue_getnext(&base->active))) {
1441			struct hrtimer *timer;
1442
1443			timer = container_of(node, struct hrtimer, node);
1444
1445			/*
1446			 * The immediate goal for using the softexpires is
1447			 * minimizing wakeups, not running timers at the
1448			 * earliest interrupt after their soft expiration.
1449			 * This allows us to avoid using a Priority Search
1450			 * Tree, which can answer a stabbing querry for
1451			 * overlapping intervals and instead use the simple
1452			 * BST we already have.
1453			 * We don't add extra wakeups by delaying timers that
1454			 * are right-of a not yet expired timer, because that
1455			 * timer will have to trigger a wakeup anyway.
1456			 */
1457			if (basenow < hrtimer_get_softexpires_tv64(timer))
1458				break;
1459
1460			__run_hrtimer(cpu_base, base, timer, &basenow, flags);
 
 
1461		}
1462	}
1463}
1464
1465static __latent_entropy void hrtimer_run_softirq(struct softirq_action *h)
1466{
1467	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1468	unsigned long flags;
1469	ktime_t now;
1470
 
1471	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1472
1473	now = hrtimer_update_base(cpu_base);
1474	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_SOFT);
1475
1476	cpu_base->softirq_activated = 0;
1477	hrtimer_update_softirq_timer(cpu_base, true);
1478
1479	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
 
1480}
1481
1482#ifdef CONFIG_HIGH_RES_TIMERS
1483
1484/*
1485 * High resolution timer interrupt
1486 * Called with interrupts disabled
1487 */
1488void hrtimer_interrupt(struct clock_event_device *dev)
1489{
1490	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1491	ktime_t expires_next, now, entry_time, delta;
1492	unsigned long flags;
1493	int retries = 0;
1494
1495	BUG_ON(!cpu_base->hres_active);
1496	cpu_base->nr_events++;
1497	dev->next_event = KTIME_MAX;
1498
1499	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1500	entry_time = now = hrtimer_update_base(cpu_base);
1501retry:
1502	cpu_base->in_hrtirq = 1;
1503	/*
1504	 * We set expires_next to KTIME_MAX here with cpu_base->lock
1505	 * held to prevent that a timer is enqueued in our queue via
1506	 * the migration code. This does not affect enqueueing of
1507	 * timers which run their callback and need to be requeued on
1508	 * this CPU.
1509	 */
1510	cpu_base->expires_next = KTIME_MAX;
1511
1512	if (!ktime_before(now, cpu_base->softirq_expires_next)) {
1513		cpu_base->softirq_expires_next = KTIME_MAX;
1514		cpu_base->softirq_activated = 1;
1515		raise_softirq_irqoff(HRTIMER_SOFTIRQ);
1516	}
1517
1518	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_HARD);
1519
1520	/* Reevaluate the clock bases for the next expiry */
1521	expires_next = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_ALL);
1522	/*
1523	 * Store the new expiry value so the migration code can verify
1524	 * against it.
1525	 */
1526	cpu_base->expires_next = expires_next;
1527	cpu_base->in_hrtirq = 0;
1528	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1529
1530	/* Reprogramming necessary ? */
1531	if (!tick_program_event(expires_next, 0)) {
1532		cpu_base->hang_detected = 0;
1533		return;
1534	}
1535
1536	/*
1537	 * The next timer was already expired due to:
1538	 * - tracing
1539	 * - long lasting callbacks
1540	 * - being scheduled away when running in a VM
1541	 *
1542	 * We need to prevent that we loop forever in the hrtimer
1543	 * interrupt routine. We give it 3 attempts to avoid
1544	 * overreacting on some spurious event.
1545	 *
1546	 * Acquire base lock for updating the offsets and retrieving
1547	 * the current time.
1548	 */
1549	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1550	now = hrtimer_update_base(cpu_base);
1551	cpu_base->nr_retries++;
1552	if (++retries < 3)
1553		goto retry;
1554	/*
1555	 * Give the system a chance to do something else than looping
1556	 * here. We stored the entry time, so we know exactly how long
1557	 * we spent here. We schedule the next event this amount of
1558	 * time away.
1559	 */
1560	cpu_base->nr_hangs++;
1561	cpu_base->hang_detected = 1;
1562	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1563
1564	delta = ktime_sub(now, entry_time);
1565	if ((unsigned int)delta > cpu_base->max_hang_time)
1566		cpu_base->max_hang_time = (unsigned int) delta;
1567	/*
1568	 * Limit it to a sensible value as we enforce a longer
1569	 * delay. Give the CPU at least 100ms to catch up.
1570	 */
1571	if (delta > 100 * NSEC_PER_MSEC)
1572		expires_next = ktime_add_ns(now, 100 * NSEC_PER_MSEC);
1573	else
1574		expires_next = ktime_add(now, delta);
1575	tick_program_event(expires_next, 1);
1576	printk_once(KERN_WARNING "hrtimer: interrupt took %llu ns\n",
1577		    ktime_to_ns(delta));
1578}
1579
1580/* called with interrupts disabled */
1581static inline void __hrtimer_peek_ahead_timers(void)
1582{
1583	struct tick_device *td;
1584
1585	if (!hrtimer_hres_active())
1586		return;
1587
1588	td = this_cpu_ptr(&tick_cpu_device);
1589	if (td && td->evtdev)
1590		hrtimer_interrupt(td->evtdev);
1591}
1592
1593#else /* CONFIG_HIGH_RES_TIMERS */
1594
1595static inline void __hrtimer_peek_ahead_timers(void) { }
1596
1597#endif	/* !CONFIG_HIGH_RES_TIMERS */
1598
1599/*
1600 * Called from run_local_timers in hardirq context every jiffy
1601 */
1602void hrtimer_run_queues(void)
1603{
1604	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1605	unsigned long flags;
1606	ktime_t now;
1607
1608	if (__hrtimer_hres_active(cpu_base))
1609		return;
1610
1611	/*
1612	 * This _is_ ugly: We have to check periodically, whether we
1613	 * can switch to highres and / or nohz mode. The clocksource
1614	 * switch happens with xtime_lock held. Notification from
1615	 * there only sets the check bit in the tick_oneshot code,
1616	 * otherwise we might deadlock vs. xtime_lock.
1617	 */
1618	if (tick_check_oneshot_change(!hrtimer_is_hres_enabled())) {
1619		hrtimer_switch_to_hres();
1620		return;
1621	}
1622
1623	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1624	now = hrtimer_update_base(cpu_base);
1625
1626	if (!ktime_before(now, cpu_base->softirq_expires_next)) {
1627		cpu_base->softirq_expires_next = KTIME_MAX;
1628		cpu_base->softirq_activated = 1;
1629		raise_softirq_irqoff(HRTIMER_SOFTIRQ);
1630	}
1631
1632	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_HARD);
1633	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1634}
1635
1636/*
1637 * Sleep related functions:
1638 */
1639static enum hrtimer_restart hrtimer_wakeup(struct hrtimer *timer)
1640{
1641	struct hrtimer_sleeper *t =
1642		container_of(timer, struct hrtimer_sleeper, timer);
1643	struct task_struct *task = t->task;
1644
1645	t->task = NULL;
1646	if (task)
1647		wake_up_process(task);
1648
1649	return HRTIMER_NORESTART;
1650}
1651
1652void hrtimer_init_sleeper(struct hrtimer_sleeper *sl, struct task_struct *task)
 
 
 
 
 
 
 
 
 
1653{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1654	sl->timer.function = hrtimer_wakeup;
1655	sl->task = task;
 
 
 
 
 
 
 
 
 
 
 
 
 
1656}
1657EXPORT_SYMBOL_GPL(hrtimer_init_sleeper);
1658
1659int nanosleep_copyout(struct restart_block *restart, struct timespec64 *ts)
1660{
1661	switch(restart->nanosleep.type) {
1662#ifdef CONFIG_COMPAT
1663	case TT_COMPAT:
1664		if (compat_put_timespec64(ts, restart->nanosleep.compat_rmtp))
1665			return -EFAULT;
1666		break;
1667#endif
1668	case TT_NATIVE:
1669		if (put_timespec64(ts, restart->nanosleep.rmtp))
1670			return -EFAULT;
1671		break;
1672	default:
1673		BUG();
1674	}
1675	return -ERESTART_RESTARTBLOCK;
1676}
1677
1678static int __sched do_nanosleep(struct hrtimer_sleeper *t, enum hrtimer_mode mode)
1679{
1680	struct restart_block *restart;
1681
1682	hrtimer_init_sleeper(t, current);
1683
1684	do {
1685		set_current_state(TASK_INTERRUPTIBLE);
1686		hrtimer_start_expires(&t->timer, mode);
1687
1688		if (likely(t->task))
1689			freezable_schedule();
1690
1691		hrtimer_cancel(&t->timer);
1692		mode = HRTIMER_MODE_ABS;
1693
1694	} while (t->task && !signal_pending(current));
1695
1696	__set_current_state(TASK_RUNNING);
1697
1698	if (!t->task)
1699		return 0;
1700
1701	restart = &current->restart_block;
1702	if (restart->nanosleep.type != TT_NONE) {
1703		ktime_t rem = hrtimer_expires_remaining(&t->timer);
1704		struct timespec64 rmt;
1705
1706		if (rem <= 0)
1707			return 0;
1708		rmt = ktime_to_timespec64(rem);
1709
1710		return nanosleep_copyout(restart, &rmt);
1711	}
1712	return -ERESTART_RESTARTBLOCK;
1713}
1714
1715static long __sched hrtimer_nanosleep_restart(struct restart_block *restart)
1716{
1717	struct hrtimer_sleeper t;
1718	int ret;
1719
1720	hrtimer_init_on_stack(&t.timer, restart->nanosleep.clockid,
1721				HRTIMER_MODE_ABS);
1722	hrtimer_set_expires_tv64(&t.timer, restart->nanosleep.expires);
1723
1724	ret = do_nanosleep(&t, HRTIMER_MODE_ABS);
1725	destroy_hrtimer_on_stack(&t.timer);
1726	return ret;
1727}
1728
1729long hrtimer_nanosleep(const struct timespec64 *rqtp,
1730		       const enum hrtimer_mode mode, const clockid_t clockid)
1731{
1732	struct restart_block *restart;
1733	struct hrtimer_sleeper t;
1734	int ret = 0;
1735	u64 slack;
1736
1737	slack = current->timer_slack_ns;
1738	if (dl_task(current) || rt_task(current))
1739		slack = 0;
1740
1741	hrtimer_init_on_stack(&t.timer, clockid, mode);
1742	hrtimer_set_expires_range_ns(&t.timer, timespec64_to_ktime(*rqtp), slack);
1743	ret = do_nanosleep(&t, mode);
1744	if (ret != -ERESTART_RESTARTBLOCK)
1745		goto out;
1746
1747	/* Absolute timers do not update the rmtp value and restart: */
1748	if (mode == HRTIMER_MODE_ABS) {
1749		ret = -ERESTARTNOHAND;
1750		goto out;
1751	}
1752
1753	restart = &current->restart_block;
1754	restart->fn = hrtimer_nanosleep_restart;
1755	restart->nanosleep.clockid = t.timer.base->clockid;
1756	restart->nanosleep.expires = hrtimer_get_expires_tv64(&t.timer);
 
1757out:
1758	destroy_hrtimer_on_stack(&t.timer);
1759	return ret;
1760}
1761
1762SYSCALL_DEFINE2(nanosleep, struct timespec __user *, rqtp,
1763		struct timespec __user *, rmtp)
 
 
1764{
1765	struct timespec64 tu;
1766
1767	if (get_timespec64(&tu, rqtp))
1768		return -EFAULT;
1769
1770	if (!timespec64_valid(&tu))
1771		return -EINVAL;
1772
 
1773	current->restart_block.nanosleep.type = rmtp ? TT_NATIVE : TT_NONE;
1774	current->restart_block.nanosleep.rmtp = rmtp;
1775	return hrtimer_nanosleep(&tu, HRTIMER_MODE_REL, CLOCK_MONOTONIC);
 
1776}
1777
1778#ifdef CONFIG_COMPAT
1779
1780COMPAT_SYSCALL_DEFINE2(nanosleep, struct compat_timespec __user *, rqtp,
1781		       struct compat_timespec __user *, rmtp)
 
 
1782{
1783	struct timespec64 tu;
1784
1785	if (compat_get_timespec64(&tu, rqtp))
1786		return -EFAULT;
1787
1788	if (!timespec64_valid(&tu))
1789		return -EINVAL;
1790
 
1791	current->restart_block.nanosleep.type = rmtp ? TT_COMPAT : TT_NONE;
1792	current->restart_block.nanosleep.compat_rmtp = rmtp;
1793	return hrtimer_nanosleep(&tu, HRTIMER_MODE_REL, CLOCK_MONOTONIC);
 
1794}
1795#endif
1796
1797/*
1798 * Functions related to boot-time initialization:
1799 */
1800int hrtimers_prepare_cpu(unsigned int cpu)
1801{
1802	struct hrtimer_cpu_base *cpu_base = &per_cpu(hrtimer_bases, cpu);
1803	int i;
1804
1805	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
1806		cpu_base->clock_base[i].cpu_base = cpu_base;
1807		timerqueue_init_head(&cpu_base->clock_base[i].active);
 
 
 
1808	}
1809
1810	cpu_base->cpu = cpu;
 
 
 
 
 
 
 
 
 
1811	cpu_base->active_bases = 0;
1812	cpu_base->hres_active = 0;
1813	cpu_base->hang_detected = 0;
1814	cpu_base->next_timer = NULL;
1815	cpu_base->softirq_next_timer = NULL;
1816	cpu_base->expires_next = KTIME_MAX;
1817	cpu_base->softirq_expires_next = KTIME_MAX;
 
1818	return 0;
1819}
1820
1821#ifdef CONFIG_HOTPLUG_CPU
1822
1823static void migrate_hrtimer_list(struct hrtimer_clock_base *old_base,
1824				struct hrtimer_clock_base *new_base)
1825{
1826	struct hrtimer *timer;
1827	struct timerqueue_node *node;
1828
1829	while ((node = timerqueue_getnext(&old_base->active))) {
1830		timer = container_of(node, struct hrtimer, node);
1831		BUG_ON(hrtimer_callback_running(timer));
1832		debug_deactivate(timer);
1833
1834		/*
1835		 * Mark it as ENQUEUED not INACTIVE otherwise the
1836		 * timer could be seen as !active and just vanish away
1837		 * under us on another CPU
1838		 */
1839		__remove_hrtimer(timer, old_base, HRTIMER_STATE_ENQUEUED, 0);
1840		timer->base = new_base;
1841		/*
1842		 * Enqueue the timers on the new cpu. This does not
1843		 * reprogram the event device in case the timer
1844		 * expires before the earliest on this CPU, but we run
1845		 * hrtimer_interrupt after we migrated everything to
1846		 * sort out already expired timers and reprogram the
1847		 * event device.
1848		 */
1849		enqueue_hrtimer(timer, new_base, HRTIMER_MODE_ABS);
1850	}
1851}
1852
1853int hrtimers_dead_cpu(unsigned int scpu)
1854{
 
1855	struct hrtimer_cpu_base *old_base, *new_base;
1856	int i;
1857
1858	BUG_ON(cpu_online(scpu));
1859	tick_cancel_sched_timer(scpu);
1860
1861	/*
1862	 * this BH disable ensures that raise_softirq_irqoff() does
1863	 * not wakeup ksoftirqd (and acquire the pi-lock) while
1864	 * holding the cpu_base lock
1865	 */
1866	local_bh_disable();
1867	local_irq_disable();
1868	old_base = &per_cpu(hrtimer_bases, scpu);
1869	new_base = this_cpu_ptr(&hrtimer_bases);
1870	/*
1871	 * The caller is globally serialized and nobody else
1872	 * takes two locks at once, deadlock is not possible.
1873	 */
1874	raw_spin_lock(&new_base->lock);
1875	raw_spin_lock_nested(&old_base->lock, SINGLE_DEPTH_NESTING);
1876
1877	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
1878		migrate_hrtimer_list(&old_base->clock_base[i],
1879				     &new_base->clock_base[i]);
1880	}
1881
1882	/*
1883	 * The migration might have changed the first expiring softirq
1884	 * timer on this CPU. Update it.
1885	 */
1886	hrtimer_update_softirq_timer(new_base, false);
 
 
1887
1888	raw_spin_unlock(&old_base->lock);
1889	raw_spin_unlock(&new_base->lock);
 
 
1890
1891	/* Check, if we got expired work to do */
1892	__hrtimer_peek_ahead_timers();
1893	local_irq_enable();
1894	local_bh_enable();
1895	return 0;
1896}
1897
1898#endif /* CONFIG_HOTPLUG_CPU */
1899
1900void __init hrtimers_init(void)
1901{
1902	hrtimers_prepare_cpu(smp_processor_id());
 
1903	open_softirq(HRTIMER_SOFTIRQ, hrtimer_run_softirq);
1904}
1905
1906/**
1907 * schedule_hrtimeout_range_clock - sleep until timeout
1908 * @expires:	timeout value (ktime_t)
1909 * @delta:	slack in expires timeout (ktime_t)
1910 * @mode:	timer mode
1911 * @clock_id:	timer clock to be used
1912 */
1913int __sched
1914schedule_hrtimeout_range_clock(ktime_t *expires, u64 delta,
1915			       const enum hrtimer_mode mode, clockid_t clock_id)
1916{
1917	struct hrtimer_sleeper t;
1918
1919	/*
1920	 * Optimize when a zero timeout value is given. It does not
1921	 * matter whether this is an absolute or a relative time.
1922	 */
1923	if (expires && *expires == 0) {
1924		__set_current_state(TASK_RUNNING);
1925		return 0;
1926	}
1927
1928	/*
1929	 * A NULL parameter means "infinite"
1930	 */
1931	if (!expires) {
1932		schedule();
1933		return -EINTR;
1934	}
1935
1936	hrtimer_init_on_stack(&t.timer, clock_id, mode);
1937	hrtimer_set_expires_range_ns(&t.timer, *expires, delta);
1938
1939	hrtimer_init_sleeper(&t, current);
1940
1941	hrtimer_start_expires(&t.timer, mode);
1942
1943	if (likely(t.task))
1944		schedule();
1945
1946	hrtimer_cancel(&t.timer);
1947	destroy_hrtimer_on_stack(&t.timer);
1948
1949	__set_current_state(TASK_RUNNING);
1950
1951	return !t.task ? 0 : -EINTR;
1952}
1953
1954/**
1955 * schedule_hrtimeout_range - sleep until timeout
1956 * @expires:	timeout value (ktime_t)
1957 * @delta:	slack in expires timeout (ktime_t)
1958 * @mode:	timer mode
1959 *
1960 * Make the current task sleep until the given expiry time has
1961 * elapsed. The routine will return immediately unless
1962 * the current task state has been set (see set_current_state()).
1963 *
1964 * The @delta argument gives the kernel the freedom to schedule the
1965 * actual wakeup to a time that is both power and performance friendly.
1966 * The kernel give the normal best effort behavior for "@expires+@delta",
1967 * but may decide to fire the timer earlier, but no earlier than @expires.
1968 *
1969 * You can set the task state as follows -
1970 *
1971 * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
1972 * pass before the routine returns unless the current task is explicitly
1973 * woken up, (e.g. by wake_up_process()).
1974 *
1975 * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
1976 * delivered to the current task or the current task is explicitly woken
1977 * up.
1978 *
1979 * The current task state is guaranteed to be TASK_RUNNING when this
1980 * routine returns.
1981 *
1982 * Returns 0 when the timer has expired. If the task was woken before the
1983 * timer expired by a signal (only possible in state TASK_INTERRUPTIBLE) or
1984 * by an explicit wakeup, it returns -EINTR.
1985 */
1986int __sched schedule_hrtimeout_range(ktime_t *expires, u64 delta,
1987				     const enum hrtimer_mode mode)
1988{
1989	return schedule_hrtimeout_range_clock(expires, delta, mode,
1990					      CLOCK_MONOTONIC);
1991}
1992EXPORT_SYMBOL_GPL(schedule_hrtimeout_range);
1993
1994/**
1995 * schedule_hrtimeout - sleep until timeout
1996 * @expires:	timeout value (ktime_t)
1997 * @mode:	timer mode
1998 *
1999 * Make the current task sleep until the given expiry time has
2000 * elapsed. The routine will return immediately unless
2001 * the current task state has been set (see set_current_state()).
2002 *
2003 * You can set the task state as follows -
2004 *
2005 * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
2006 * pass before the routine returns unless the current task is explicitly
2007 * woken up, (e.g. by wake_up_process()).
2008 *
2009 * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
2010 * delivered to the current task or the current task is explicitly woken
2011 * up.
2012 *
2013 * The current task state is guaranteed to be TASK_RUNNING when this
2014 * routine returns.
2015 *
2016 * Returns 0 when the timer has expired. If the task was woken before the
2017 * timer expired by a signal (only possible in state TASK_INTERRUPTIBLE) or
2018 * by an explicit wakeup, it returns -EINTR.
2019 */
2020int __sched schedule_hrtimeout(ktime_t *expires,
2021			       const enum hrtimer_mode mode)
2022{
2023	return schedule_hrtimeout_range(expires, 0, mode);
2024}
2025EXPORT_SYMBOL_GPL(schedule_hrtimeout);
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0
   2/*
 
 
   3 *  Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
   4 *  Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
   5 *  Copyright(C) 2006-2007  Timesys Corp., Thomas Gleixner
   6 *
   7 *  High-resolution kernel timers
   8 *
   9 *  In contrast to the low-resolution timeout API, aka timer wheel,
  10 *  hrtimers provide finer resolution and accuracy depending on system
  11 *  configuration and capabilities.
 
 
 
 
 
 
  12 *
  13 *  Started by: Thomas Gleixner and Ingo Molnar
  14 *
  15 *  Credits:
  16 *	Based on the original timer wheel code
  17 *
  18 *	Help, testing, suggestions, bugfixes, improvements were
  19 *	provided by:
  20 *
  21 *	George Anzinger, Andrew Morton, Steven Rostedt, Roman Zippel
  22 *	et. al.
 
 
  23 */
  24
  25#include <linux/cpu.h>
  26#include <linux/export.h>
  27#include <linux/percpu.h>
  28#include <linux/hrtimer.h>
  29#include <linux/notifier.h>
  30#include <linux/syscalls.h>
  31#include <linux/interrupt.h>
  32#include <linux/tick.h>
 
  33#include <linux/err.h>
  34#include <linux/debugobjects.h>
  35#include <linux/sched/signal.h>
  36#include <linux/sched/sysctl.h>
  37#include <linux/sched/rt.h>
  38#include <linux/sched/deadline.h>
  39#include <linux/sched/nohz.h>
  40#include <linux/sched/debug.h>
  41#include <linux/sched/isolation.h>
  42#include <linux/timer.h>
  43#include <linux/freezer.h>
  44#include <linux/compat.h>
  45
  46#include <linux/uaccess.h>
  47
  48#include <trace/events/timer.h>
  49
  50#include "tick-internal.h"
  51
  52/*
  53 * Masks for selecting the soft and hard context timers from
  54 * cpu_base->active
  55 */
  56#define MASK_SHIFT		(HRTIMER_BASE_MONOTONIC_SOFT)
  57#define HRTIMER_ACTIVE_HARD	((1U << MASK_SHIFT) - 1)
  58#define HRTIMER_ACTIVE_SOFT	(HRTIMER_ACTIVE_HARD << MASK_SHIFT)
  59#define HRTIMER_ACTIVE_ALL	(HRTIMER_ACTIVE_SOFT | HRTIMER_ACTIVE_HARD)
  60
  61static void retrigger_next_event(void *arg);
  62
  63/*
  64 * The timer bases:
  65 *
  66 * There are more clockids than hrtimer bases. Thus, we index
  67 * into the timer bases by the hrtimer_base_type enum. When trying
  68 * to reach a base using a clockid, hrtimer_clockid_to_base()
  69 * is used to convert from clockid to the proper hrtimer_base_type.
  70 */
  71DEFINE_PER_CPU(struct hrtimer_cpu_base, hrtimer_bases) =
  72{
  73	.lock = __RAW_SPIN_LOCK_UNLOCKED(hrtimer_bases.lock),
  74	.clock_base =
  75	{
  76		{
  77			.index = HRTIMER_BASE_MONOTONIC,
  78			.clockid = CLOCK_MONOTONIC,
  79			.get_time = &ktime_get,
  80		},
  81		{
  82			.index = HRTIMER_BASE_REALTIME,
  83			.clockid = CLOCK_REALTIME,
  84			.get_time = &ktime_get_real,
  85		},
  86		{
  87			.index = HRTIMER_BASE_BOOTTIME,
  88			.clockid = CLOCK_BOOTTIME,
  89			.get_time = &ktime_get_boottime,
  90		},
  91		{
  92			.index = HRTIMER_BASE_TAI,
  93			.clockid = CLOCK_TAI,
  94			.get_time = &ktime_get_clocktai,
  95		},
  96		{
  97			.index = HRTIMER_BASE_MONOTONIC_SOFT,
  98			.clockid = CLOCK_MONOTONIC,
  99			.get_time = &ktime_get,
 100		},
 101		{
 102			.index = HRTIMER_BASE_REALTIME_SOFT,
 103			.clockid = CLOCK_REALTIME,
 104			.get_time = &ktime_get_real,
 105		},
 106		{
 107			.index = HRTIMER_BASE_BOOTTIME_SOFT,
 108			.clockid = CLOCK_BOOTTIME,
 109			.get_time = &ktime_get_boottime,
 110		},
 111		{
 112			.index = HRTIMER_BASE_TAI_SOFT,
 113			.clockid = CLOCK_TAI,
 114			.get_time = &ktime_get_clocktai,
 115		},
 116	},
 117	.csd = CSD_INIT(retrigger_next_event, NULL)
 118};
 119
 120static const int hrtimer_clock_to_base_table[MAX_CLOCKS] = {
 121	/* Make sure we catch unsupported clockids */
 122	[0 ... MAX_CLOCKS - 1]	= HRTIMER_MAX_CLOCK_BASES,
 123
 124	[CLOCK_REALTIME]	= HRTIMER_BASE_REALTIME,
 125	[CLOCK_MONOTONIC]	= HRTIMER_BASE_MONOTONIC,
 126	[CLOCK_BOOTTIME]	= HRTIMER_BASE_BOOTTIME,
 127	[CLOCK_TAI]		= HRTIMER_BASE_TAI,
 128};
 129
 130static inline bool hrtimer_base_is_online(struct hrtimer_cpu_base *base)
 131{
 132	if (!IS_ENABLED(CONFIG_HOTPLUG_CPU))
 133		return true;
 134	else
 135		return likely(base->online);
 136}
 137
 138/*
 139 * Functions and macros which are different for UP/SMP systems are kept in a
 140 * single place
 141 */
 142#ifdef CONFIG_SMP
 143
 144/*
 145 * We require the migration_base for lock_hrtimer_base()/switch_hrtimer_base()
 146 * such that hrtimer_callback_running() can unconditionally dereference
 147 * timer->base->cpu_base
 148 */
 149static struct hrtimer_cpu_base migration_cpu_base = {
 150	.clock_base = { {
 151		.cpu_base = &migration_cpu_base,
 152		.seq      = SEQCNT_RAW_SPINLOCK_ZERO(migration_cpu_base.seq,
 153						     &migration_cpu_base.lock),
 154	}, },
 155};
 156
 157#define migration_base	migration_cpu_base.clock_base[0]
 158
 159static inline bool is_migration_base(struct hrtimer_clock_base *base)
 160{
 161	return base == &migration_base;
 162}
 163
 164/*
 165 * We are using hashed locking: holding per_cpu(hrtimer_bases)[n].lock
 166 * means that all timers which are tied to this base via timer->base are
 167 * locked, and the base itself is locked too.
 168 *
 169 * So __run_timers/migrate_timers can safely modify all timers which could
 170 * be found on the lists/queues.
 171 *
 172 * When the timer's base is locked, and the timer removed from list, it is
 173 * possible to set timer->base = &migration_base and drop the lock: the timer
 174 * remains locked.
 175 */
 176static
 177struct hrtimer_clock_base *lock_hrtimer_base(const struct hrtimer *timer,
 178					     unsigned long *flags)
 179	__acquires(&timer->base->lock)
 180{
 181	struct hrtimer_clock_base *base;
 182
 183	for (;;) {
 184		base = READ_ONCE(timer->base);
 185		if (likely(base != &migration_base)) {
 186			raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
 187			if (likely(base == timer->base))
 188				return base;
 189			/* The timer has migrated to another CPU: */
 190			raw_spin_unlock_irqrestore(&base->cpu_base->lock, *flags);
 191		}
 192		cpu_relax();
 193	}
 194}
 195
 196/*
 197 * Check if the elected target is suitable considering its next
 198 * event and the hotplug state of the current CPU.
 199 *
 200 * If the elected target is remote and its next event is after the timer
 201 * to queue, then a remote reprogram is necessary. However there is no
 202 * guarantee the IPI handling the operation would arrive in time to meet
 203 * the high resolution deadline. In this case the local CPU becomes a
 204 * preferred target, unless it is offline.
 205 *
 206 * High and low resolution modes are handled the same way for simplicity.
 207 *
 208 * Called with cpu_base->lock of target cpu held.
 209 */
 210static bool hrtimer_suitable_target(struct hrtimer *timer, struct hrtimer_clock_base *new_base,
 211				    struct hrtimer_cpu_base *new_cpu_base,
 212				    struct hrtimer_cpu_base *this_cpu_base)
 213{
 214	ktime_t expires;
 215
 216	/*
 217	 * The local CPU clockevent can be reprogrammed. Also get_target_base()
 218	 * guarantees it is online.
 219	 */
 220	if (new_cpu_base == this_cpu_base)
 221		return true;
 222
 223	/*
 224	 * The offline local CPU can't be the default target if the
 225	 * next remote target event is after this timer. Keep the
 226	 * elected new base. An IPI will we issued to reprogram
 227	 * it as a last resort.
 228	 */
 229	if (!hrtimer_base_is_online(this_cpu_base))
 230		return true;
 231
 232	expires = ktime_sub(hrtimer_get_expires(timer), new_base->offset);
 233
 234	return expires >= new_base->cpu_base->expires_next;
 235}
 236
 237static inline struct hrtimer_cpu_base *get_target_base(struct hrtimer_cpu_base *base, int pinned)
 
 
 238{
 239	if (!hrtimer_base_is_online(base)) {
 240		int cpu = cpumask_any_and(cpu_online_mask, housekeeping_cpumask(HK_TYPE_TIMER));
 241
 242		return &per_cpu(hrtimer_bases, cpu);
 243	}
 244
 245#if defined(CONFIG_SMP) && defined(CONFIG_NO_HZ_COMMON)
 246	if (static_branch_likely(&timers_migration_enabled) && !pinned)
 247		return &per_cpu(hrtimer_bases, get_nohz_timer_target());
 248#endif
 249	return base;
 250}
 251
 252/*
 253 * We switch the timer base to a power-optimized selected CPU target,
 254 * if:
 255 *	- NO_HZ_COMMON is enabled
 256 *	- timer migration is enabled
 257 *	- the timer callback is not running
 258 *	- the timer is not the first expiring timer on the new target
 259 *
 260 * If one of the above requirements is not fulfilled we move the timer
 261 * to the current CPU or leave it on the previously assigned CPU if
 262 * the timer callback is currently running.
 263 */
 264static inline struct hrtimer_clock_base *
 265switch_hrtimer_base(struct hrtimer *timer, struct hrtimer_clock_base *base,
 266		    int pinned)
 267{
 268	struct hrtimer_cpu_base *new_cpu_base, *this_cpu_base;
 269	struct hrtimer_clock_base *new_base;
 270	int basenum = base->index;
 271
 272	this_cpu_base = this_cpu_ptr(&hrtimer_bases);
 273	new_cpu_base = get_target_base(this_cpu_base, pinned);
 274again:
 275	new_base = &new_cpu_base->clock_base[basenum];
 276
 277	if (base != new_base) {
 278		/*
 279		 * We are trying to move timer to new_base.
 280		 * However we can't change timer's base while it is running,
 281		 * so we keep it on the same CPU. No hassle vs. reprogramming
 282		 * the event source in the high resolution case. The softirq
 283		 * code will take care of this when the timer function has
 284		 * completed. There is no conflict as we hold the lock until
 285		 * the timer is enqueued.
 286		 */
 287		if (unlikely(hrtimer_callback_running(timer)))
 288			return base;
 289
 290		/* See the comment in lock_hrtimer_base() */
 291		WRITE_ONCE(timer->base, &migration_base);
 292		raw_spin_unlock(&base->cpu_base->lock);
 293		raw_spin_lock(&new_base->cpu_base->lock);
 294
 295		if (!hrtimer_suitable_target(timer, new_base, new_cpu_base,
 296					     this_cpu_base)) {
 297			raw_spin_unlock(&new_base->cpu_base->lock);
 298			raw_spin_lock(&base->cpu_base->lock);
 299			new_cpu_base = this_cpu_base;
 300			WRITE_ONCE(timer->base, base);
 301			goto again;
 302		}
 303		WRITE_ONCE(timer->base, new_base);
 304	} else {
 305		if (!hrtimer_suitable_target(timer, new_base,  new_cpu_base, this_cpu_base)) {
 
 306			new_cpu_base = this_cpu_base;
 307			goto again;
 308		}
 309	}
 310	return new_base;
 311}
 312
 313#else /* CONFIG_SMP */
 314
 315static inline bool is_migration_base(struct hrtimer_clock_base *base)
 316{
 317	return false;
 318}
 319
 320static inline struct hrtimer_clock_base *
 321lock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
 322	__acquires(&timer->base->cpu_base->lock)
 323{
 324	struct hrtimer_clock_base *base = timer->base;
 325
 326	raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
 327
 328	return base;
 329}
 330
 331# define switch_hrtimer_base(t, b, p)	(b)
 332
 333#endif	/* !CONFIG_SMP */
 334
 335/*
 336 * Functions for the union type storage format of ktime_t which are
 337 * too large for inlining:
 338 */
 339#if BITS_PER_LONG < 64
 340/*
 341 * Divide a ktime value by a nanosecond value
 342 */
 343s64 __ktime_divns(const ktime_t kt, s64 div)
 344{
 345	int sft = 0;
 346	s64 dclc;
 347	u64 tmp;
 348
 349	dclc = ktime_to_ns(kt);
 350	tmp = dclc < 0 ? -dclc : dclc;
 351
 352	/* Make sure the divisor is less than 2^32: */
 353	while (div >> 32) {
 354		sft++;
 355		div >>= 1;
 356	}
 357	tmp >>= sft;
 358	do_div(tmp, (u32) div);
 359	return dclc < 0 ? -tmp : tmp;
 360}
 361EXPORT_SYMBOL_GPL(__ktime_divns);
 362#endif /* BITS_PER_LONG >= 64 */
 363
 364/*
 365 * Add two ktime values and do a safety check for overflow:
 366 */
 367ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs)
 368{
 369	ktime_t res = ktime_add_unsafe(lhs, rhs);
 370
 371	/*
 372	 * We use KTIME_SEC_MAX here, the maximum timeout which we can
 373	 * return to user space in a timespec:
 374	 */
 375	if (res < 0 || res < lhs || res < rhs)
 376		res = ktime_set(KTIME_SEC_MAX, 0);
 377
 378	return res;
 379}
 380
 381EXPORT_SYMBOL_GPL(ktime_add_safe);
 382
 383#ifdef CONFIG_DEBUG_OBJECTS_TIMERS
 384
 385static const struct debug_obj_descr hrtimer_debug_descr;
 386
 387static void *hrtimer_debug_hint(void *addr)
 388{
 389	return ((struct hrtimer *) addr)->function;
 390}
 391
 392/*
 393 * fixup_init is called when:
 394 * - an active object is initialized
 395 */
 396static bool hrtimer_fixup_init(void *addr, enum debug_obj_state state)
 397{
 398	struct hrtimer *timer = addr;
 399
 400	switch (state) {
 401	case ODEBUG_STATE_ACTIVE:
 402		hrtimer_cancel(timer);
 403		debug_object_init(timer, &hrtimer_debug_descr);
 404		return true;
 405	default:
 406		return false;
 407	}
 408}
 409
 410/*
 411 * fixup_activate is called when:
 412 * - an active object is activated
 413 * - an unknown non-static object is activated
 414 */
 415static bool hrtimer_fixup_activate(void *addr, enum debug_obj_state state)
 416{
 417	switch (state) {
 418	case ODEBUG_STATE_ACTIVE:
 419		WARN_ON(1);
 420		fallthrough;
 421	default:
 422		return false;
 423	}
 424}
 425
 426/*
 427 * fixup_free is called when:
 428 * - an active object is freed
 429 */
 430static bool hrtimer_fixup_free(void *addr, enum debug_obj_state state)
 431{
 432	struct hrtimer *timer = addr;
 433
 434	switch (state) {
 435	case ODEBUG_STATE_ACTIVE:
 436		hrtimer_cancel(timer);
 437		debug_object_free(timer, &hrtimer_debug_descr);
 438		return true;
 439	default:
 440		return false;
 441	}
 442}
 443
 444static const struct debug_obj_descr hrtimer_debug_descr = {
 445	.name		= "hrtimer",
 446	.debug_hint	= hrtimer_debug_hint,
 447	.fixup_init	= hrtimer_fixup_init,
 448	.fixup_activate	= hrtimer_fixup_activate,
 449	.fixup_free	= hrtimer_fixup_free,
 450};
 451
 452static inline void debug_hrtimer_init(struct hrtimer *timer)
 453{
 454	debug_object_init(timer, &hrtimer_debug_descr);
 455}
 456
 457static inline void debug_hrtimer_init_on_stack(struct hrtimer *timer)
 458{
 459	debug_object_init_on_stack(timer, &hrtimer_debug_descr);
 460}
 461
 462static inline void debug_hrtimer_activate(struct hrtimer *timer,
 463					  enum hrtimer_mode mode)
 464{
 465	debug_object_activate(timer, &hrtimer_debug_descr);
 466}
 467
 468static inline void debug_hrtimer_deactivate(struct hrtimer *timer)
 469{
 470	debug_object_deactivate(timer, &hrtimer_debug_descr);
 471}
 472
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 473void destroy_hrtimer_on_stack(struct hrtimer *timer)
 474{
 475	debug_object_free(timer, &hrtimer_debug_descr);
 476}
 477EXPORT_SYMBOL_GPL(destroy_hrtimer_on_stack);
 478
 479#else
 480
 481static inline void debug_hrtimer_init(struct hrtimer *timer) { }
 482static inline void debug_hrtimer_init_on_stack(struct hrtimer *timer) { }
 483static inline void debug_hrtimer_activate(struct hrtimer *timer,
 484					  enum hrtimer_mode mode) { }
 485static inline void debug_hrtimer_deactivate(struct hrtimer *timer) { }
 486#endif
 487
 488static inline void
 489debug_init(struct hrtimer *timer, clockid_t clockid,
 490	   enum hrtimer_mode mode)
 491{
 492	debug_hrtimer_init(timer);
 493	trace_hrtimer_init(timer, clockid, mode);
 494}
 495
 496static inline void debug_init_on_stack(struct hrtimer *timer, clockid_t clockid,
 497				       enum hrtimer_mode mode)
 498{
 499	debug_hrtimer_init_on_stack(timer);
 500	trace_hrtimer_init(timer, clockid, mode);
 501}
 502
 503static inline void debug_activate(struct hrtimer *timer,
 504				  enum hrtimer_mode mode)
 505{
 506	debug_hrtimer_activate(timer, mode);
 507	trace_hrtimer_start(timer, mode);
 508}
 509
 510static inline void debug_deactivate(struct hrtimer *timer)
 511{
 512	debug_hrtimer_deactivate(timer);
 513	trace_hrtimer_cancel(timer);
 514}
 515
 516static struct hrtimer_clock_base *
 517__next_base(struct hrtimer_cpu_base *cpu_base, unsigned int *active)
 518{
 519	unsigned int idx;
 520
 521	if (!*active)
 522		return NULL;
 523
 524	idx = __ffs(*active);
 525	*active &= ~(1U << idx);
 526
 527	return &cpu_base->clock_base[idx];
 528}
 529
 530#define for_each_active_base(base, cpu_base, active)	\
 531	while ((base = __next_base((cpu_base), &(active))))
 532
 533static ktime_t __hrtimer_next_event_base(struct hrtimer_cpu_base *cpu_base,
 534					 const struct hrtimer *exclude,
 535					 unsigned int active,
 536					 ktime_t expires_next)
 537{
 538	struct hrtimer_clock_base *base;
 539	ktime_t expires;
 540
 541	for_each_active_base(base, cpu_base, active) {
 542		struct timerqueue_node *next;
 543		struct hrtimer *timer;
 544
 545		next = timerqueue_getnext(&base->active);
 546		timer = container_of(next, struct hrtimer, node);
 547		if (timer == exclude) {
 548			/* Get to the next timer in the queue. */
 549			next = timerqueue_iterate_next(next);
 550			if (!next)
 551				continue;
 552
 553			timer = container_of(next, struct hrtimer, node);
 554		}
 555		expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
 556		if (expires < expires_next) {
 557			expires_next = expires;
 558
 559			/* Skip cpu_base update if a timer is being excluded. */
 560			if (exclude)
 561				continue;
 562
 563			if (timer->is_soft)
 564				cpu_base->softirq_next_timer = timer;
 565			else
 566				cpu_base->next_timer = timer;
 567		}
 568	}
 569	/*
 570	 * clock_was_set() might have changed base->offset of any of
 571	 * the clock bases so the result might be negative. Fix it up
 572	 * to prevent a false positive in clockevents_program_event().
 573	 */
 574	if (expires_next < 0)
 575		expires_next = 0;
 576	return expires_next;
 577}
 578
 579/*
 580 * Recomputes cpu_base::*next_timer and returns the earliest expires_next
 581 * but does not set cpu_base::*expires_next, that is done by
 582 * hrtimer[_force]_reprogram and hrtimer_interrupt only. When updating
 583 * cpu_base::*expires_next right away, reprogramming logic would no longer
 584 * work.
 585 *
 586 * When a softirq is pending, we can ignore the HRTIMER_ACTIVE_SOFT bases,
 587 * those timers will get run whenever the softirq gets handled, at the end of
 588 * hrtimer_run_softirq(), hrtimer_update_softirq_timer() will re-add these bases.
 589 *
 590 * Therefore softirq values are those from the HRTIMER_ACTIVE_SOFT clock bases.
 591 * The !softirq values are the minima across HRTIMER_ACTIVE_ALL, unless an actual
 592 * softirq is pending, in which case they're the minima of HRTIMER_ACTIVE_HARD.
 593 *
 594 * @active_mask must be one of:
 595 *  - HRTIMER_ACTIVE_ALL,
 596 *  - HRTIMER_ACTIVE_SOFT, or
 597 *  - HRTIMER_ACTIVE_HARD.
 598 */
 599static ktime_t
 600__hrtimer_get_next_event(struct hrtimer_cpu_base *cpu_base, unsigned int active_mask)
 601{
 602	unsigned int active;
 603	struct hrtimer *next_timer = NULL;
 604	ktime_t expires_next = KTIME_MAX;
 605
 606	if (!cpu_base->softirq_activated && (active_mask & HRTIMER_ACTIVE_SOFT)) {
 607		active = cpu_base->active_bases & HRTIMER_ACTIVE_SOFT;
 608		cpu_base->softirq_next_timer = NULL;
 609		expires_next = __hrtimer_next_event_base(cpu_base, NULL,
 610							 active, KTIME_MAX);
 611
 612		next_timer = cpu_base->softirq_next_timer;
 613	}
 614
 615	if (active_mask & HRTIMER_ACTIVE_HARD) {
 616		active = cpu_base->active_bases & HRTIMER_ACTIVE_HARD;
 617		cpu_base->next_timer = next_timer;
 618		expires_next = __hrtimer_next_event_base(cpu_base, NULL, active,
 619							 expires_next);
 620	}
 621
 622	return expires_next;
 623}
 624
 625static ktime_t hrtimer_update_next_event(struct hrtimer_cpu_base *cpu_base)
 626{
 627	ktime_t expires_next, soft = KTIME_MAX;
 628
 629	/*
 630	 * If the soft interrupt has already been activated, ignore the
 631	 * soft bases. They will be handled in the already raised soft
 632	 * interrupt.
 633	 */
 634	if (!cpu_base->softirq_activated) {
 635		soft = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_SOFT);
 636		/*
 637		 * Update the soft expiry time. clock_settime() might have
 638		 * affected it.
 639		 */
 640		cpu_base->softirq_expires_next = soft;
 641	}
 642
 643	expires_next = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_HARD);
 644	/*
 645	 * If a softirq timer is expiring first, update cpu_base->next_timer
 646	 * and program the hardware with the soft expiry time.
 647	 */
 648	if (expires_next > soft) {
 649		cpu_base->next_timer = cpu_base->softirq_next_timer;
 650		expires_next = soft;
 651	}
 652
 653	return expires_next;
 654}
 655
 656static inline ktime_t hrtimer_update_base(struct hrtimer_cpu_base *base)
 657{
 658	ktime_t *offs_real = &base->clock_base[HRTIMER_BASE_REALTIME].offset;
 659	ktime_t *offs_boot = &base->clock_base[HRTIMER_BASE_BOOTTIME].offset;
 660	ktime_t *offs_tai = &base->clock_base[HRTIMER_BASE_TAI].offset;
 661
 662	ktime_t now = ktime_get_update_offsets_now(&base->clock_was_set_seq,
 663					    offs_real, offs_boot, offs_tai);
 664
 665	base->clock_base[HRTIMER_BASE_REALTIME_SOFT].offset = *offs_real;
 666	base->clock_base[HRTIMER_BASE_BOOTTIME_SOFT].offset = *offs_boot;
 667	base->clock_base[HRTIMER_BASE_TAI_SOFT].offset = *offs_tai;
 668
 669	return now;
 670}
 671
 672/*
 673 * Is the high resolution mode active ?
 674 */
 675static inline int hrtimer_hres_active(struct hrtimer_cpu_base *cpu_base)
 676{
 677	return IS_ENABLED(CONFIG_HIGH_RES_TIMERS) ?
 678		cpu_base->hres_active : 0;
 679}
 680
 681static void __hrtimer_reprogram(struct hrtimer_cpu_base *cpu_base,
 682				struct hrtimer *next_timer,
 683				ktime_t expires_next)
 
 
 
 
 
 
 
 
 
 684{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 685	cpu_base->expires_next = expires_next;
 686
 687	/*
 688	 * If hres is not active, hardware does not have to be
 689	 * reprogrammed yet.
 690	 *
 691	 * If a hang was detected in the last timer interrupt then we
 692	 * leave the hang delay active in the hardware. We want the
 693	 * system to make progress. That also prevents the following
 694	 * scenario:
 695	 * T1 expires 50ms from now
 696	 * T2 expires 5s from now
 697	 *
 698	 * T1 is removed, so this code is called and would reprogram
 699	 * the hardware to 5s from now. Any hrtimer_start after that
 700	 * will not reprogram the hardware due to hang_detected being
 701	 * set. So we'd effectively block all timers until the T2 event
 702	 * fires.
 703	 */
 704	if (!hrtimer_hres_active(cpu_base) || cpu_base->hang_detected)
 705		return;
 706
 707	tick_program_event(expires_next, 1);
 708}
 709
 710/*
 711 * Reprogram the event source with checking both queues for the
 712 * next event
 713 * Called with interrupts disabled and base->lock held
 714 */
 715static void
 716hrtimer_force_reprogram(struct hrtimer_cpu_base *cpu_base, int skip_equal)
 717{
 718	ktime_t expires_next;
 719
 720	expires_next = hrtimer_update_next_event(cpu_base);
 721
 722	if (skip_equal && expires_next == cpu_base->expires_next)
 723		return;
 724
 725	__hrtimer_reprogram(cpu_base, cpu_base->next_timer, expires_next);
 726}
 727
 728/* High resolution timer related functions */
 729#ifdef CONFIG_HIGH_RES_TIMERS
 730
 731/*
 732 * High resolution timer enabled ?
 733 */
 734static bool hrtimer_hres_enabled __read_mostly  = true;
 735unsigned int hrtimer_resolution __read_mostly = LOW_RES_NSEC;
 736EXPORT_SYMBOL_GPL(hrtimer_resolution);
 737
 738/*
 739 * Enable / Disable high resolution mode
 740 */
 741static int __init setup_hrtimer_hres(char *str)
 742{
 743	return (kstrtobool(str, &hrtimer_hres_enabled) == 0);
 744}
 745
 746__setup("highres=", setup_hrtimer_hres);
 747
 748/*
 749 * hrtimer_high_res_enabled - query, if the highres mode is enabled
 750 */
 751static inline int hrtimer_is_hres_enabled(void)
 752{
 753	return hrtimer_hres_enabled;
 754}
 755
 756/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 757 * Switch to high resolution mode
 758 */
 759static void hrtimer_switch_to_hres(void)
 760{
 761	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
 762
 763	if (tick_init_highres()) {
 764		pr_warn("Could not switch to high resolution mode on CPU %u\n",
 765			base->cpu);
 766		return;
 767	}
 768	base->hres_active = 1;
 769	hrtimer_resolution = HIGH_RES_NSEC;
 770
 771	tick_setup_sched_timer(true);
 772	/* "Retrigger" the interrupt to get things going */
 773	retrigger_next_event(NULL);
 774}
 775
 776#else
 
 
 
 777
 778static inline int hrtimer_is_hres_enabled(void) { return 0; }
 779static inline void hrtimer_switch_to_hres(void) { }
 780
 781#endif /* CONFIG_HIGH_RES_TIMERS */
 782/*
 783 * Retrigger next event is called after clock was set with interrupts
 784 * disabled through an SMP function call or directly from low level
 785 * resume code.
 786 *
 787 * This is only invoked when:
 788 *	- CONFIG_HIGH_RES_TIMERS is enabled.
 789 *	- CONFIG_NOHZ_COMMON is enabled
 790 *
 791 * For the other cases this function is empty and because the call sites
 792 * are optimized out it vanishes as well, i.e. no need for lots of
 793 * #ifdeffery.
 794 */
 795static void retrigger_next_event(void *arg)
 796{
 797	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
 
 
 
 798
 799	/*
 800	 * When high resolution mode or nohz is active, then the offsets of
 801	 * CLOCK_REALTIME/TAI/BOOTTIME have to be updated. Otherwise the
 802	 * next tick will take care of that.
 803	 *
 804	 * If high resolution mode is active then the next expiring timer
 805	 * must be reevaluated and the clock event device reprogrammed if
 806	 * necessary.
 807	 *
 808	 * In the NOHZ case the update of the offset and the reevaluation
 809	 * of the next expiring timer is enough. The return from the SMP
 810	 * function call will take care of the reprogramming in case the
 811	 * CPU was in a NOHZ idle sleep.
 812	 */
 813	if (!hrtimer_hres_active(base) && !tick_nohz_active)
 814		return;
 815
 816	raw_spin_lock(&base->lock);
 817	hrtimer_update_base(base);
 818	if (hrtimer_hres_active(base))
 819		hrtimer_force_reprogram(base, 0);
 820	else
 821		hrtimer_update_next_event(base);
 822	raw_spin_unlock(&base->lock);
 823}
 824
 825/*
 826 * When a timer is enqueued and expires earlier than the already enqueued
 827 * timers, we have to check, whether it expires earlier than the timer for
 828 * which the clock event device was armed.
 829 *
 830 * Called with interrupts disabled and base->cpu_base.lock held
 831 */
 832static void hrtimer_reprogram(struct hrtimer *timer, bool reprogram)
 833{
 834	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
 835	struct hrtimer_clock_base *base = timer->base;
 836	ktime_t expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
 837
 838	WARN_ON_ONCE(hrtimer_get_expires_tv64(timer) < 0);
 839
 840	/*
 841	 * CLOCK_REALTIME timer might be requested with an absolute
 842	 * expiry time which is less than base->offset. Set it to 0.
 843	 */
 844	if (expires < 0)
 845		expires = 0;
 846
 847	if (timer->is_soft) {
 848		/*
 849		 * soft hrtimer could be started on a remote CPU. In this
 850		 * case softirq_expires_next needs to be updated on the
 851		 * remote CPU. The soft hrtimer will not expire before the
 852		 * first hard hrtimer on the remote CPU -
 853		 * hrtimer_check_target() prevents this case.
 854		 */
 855		struct hrtimer_cpu_base *timer_cpu_base = base->cpu_base;
 856
 857		if (timer_cpu_base->softirq_activated)
 858			return;
 859
 860		if (!ktime_before(expires, timer_cpu_base->softirq_expires_next))
 861			return;
 862
 863		timer_cpu_base->softirq_next_timer = timer;
 864		timer_cpu_base->softirq_expires_next = expires;
 865
 866		if (!ktime_before(expires, timer_cpu_base->expires_next) ||
 867		    !reprogram)
 868			return;
 869	}
 870
 871	/*
 872	 * If the timer is not on the current cpu, we cannot reprogram
 873	 * the other cpus clock event device.
 874	 */
 875	if (base->cpu_base != cpu_base)
 876		return;
 877
 878	if (expires >= cpu_base->expires_next)
 879		return;
 880
 881	/*
 882	 * If the hrtimer interrupt is running, then it will reevaluate the
 883	 * clock bases and reprogram the clock event device.
 
 
 
 884	 */
 885	if (cpu_base->in_hrtirq)
 886		return;
 887
 
 
 
 
 888	cpu_base->next_timer = timer;
 889
 890	__hrtimer_reprogram(cpu_base, timer, expires);
 891}
 892
 893static bool update_needs_ipi(struct hrtimer_cpu_base *cpu_base,
 894			     unsigned int active)
 895{
 896	struct hrtimer_clock_base *base;
 897	unsigned int seq;
 898	ktime_t expires;
 899
 900	/*
 901	 * Update the base offsets unconditionally so the following
 902	 * checks whether the SMP function call is required works.
 903	 *
 904	 * The update is safe even when the remote CPU is in the hrtimer
 905	 * interrupt or the hrtimer soft interrupt and expiring affected
 906	 * bases. Either it will see the update before handling a base or
 907	 * it will see it when it finishes the processing and reevaluates
 908	 * the next expiring timer.
 909	 */
 910	seq = cpu_base->clock_was_set_seq;
 911	hrtimer_update_base(cpu_base);
 912
 913	/*
 914	 * If the sequence did not change over the update then the
 915	 * remote CPU already handled it.
 916	 */
 917	if (seq == cpu_base->clock_was_set_seq)
 918		return false;
 919
 920	/*
 921	 * If the remote CPU is currently handling an hrtimer interrupt, it
 922	 * will reevaluate the first expiring timer of all clock bases
 923	 * before reprogramming. Nothing to do here.
 924	 */
 925	if (cpu_base->in_hrtirq)
 926		return false;
 927
 928	/*
 929	 * Walk the affected clock bases and check whether the first expiring
 930	 * timer in a clock base is moving ahead of the first expiring timer of
 931	 * @cpu_base. If so, the IPI must be invoked because per CPU clock
 932	 * event devices cannot be remotely reprogrammed.
 933	 */
 934	active &= cpu_base->active_bases;
 935
 936	for_each_active_base(base, cpu_base, active) {
 937		struct timerqueue_node *next;
 938
 939		next = timerqueue_getnext(&base->active);
 940		expires = ktime_sub(next->expires, base->offset);
 941		if (expires < cpu_base->expires_next)
 942			return true;
 943
 944		/* Extra check for softirq clock bases */
 945		if (base->clockid < HRTIMER_BASE_MONOTONIC_SOFT)
 946			continue;
 947		if (cpu_base->softirq_activated)
 948			continue;
 949		if (expires < cpu_base->softirq_expires_next)
 950			return true;
 951	}
 952	return false;
 953}
 954
 955/*
 956 * Clock was set. This might affect CLOCK_REALTIME, CLOCK_TAI and
 957 * CLOCK_BOOTTIME (for late sleep time injection).
 958 *
 959 * This requires to update the offsets for these clocks
 960 * vs. CLOCK_MONOTONIC. When high resolution timers are enabled, then this
 961 * also requires to eventually reprogram the per CPU clock event devices
 962 * when the change moves an affected timer ahead of the first expiring
 963 * timer on that CPU. Obviously remote per CPU clock event devices cannot
 964 * be reprogrammed. The other reason why an IPI has to be sent is when the
 965 * system is in !HIGH_RES and NOHZ mode. The NOHZ mode updates the offsets
 966 * in the tick, which obviously might be stopped, so this has to bring out
 967 * the remote CPU which might sleep in idle to get this sorted.
 968 */
 969void clock_was_set(unsigned int bases)
 970{
 971	struct hrtimer_cpu_base *cpu_base = raw_cpu_ptr(&hrtimer_bases);
 972	cpumask_var_t mask;
 973	int cpu;
 974
 975	if (!hrtimer_hres_active(cpu_base) && !tick_nohz_active)
 976		goto out_timerfd;
 977
 978	if (!zalloc_cpumask_var(&mask, GFP_KERNEL)) {
 979		on_each_cpu(retrigger_next_event, NULL, 1);
 980		goto out_timerfd;
 981	}
 982
 983	/* Avoid interrupting CPUs if possible */
 984	cpus_read_lock();
 985	for_each_online_cpu(cpu) {
 986		unsigned long flags;
 987
 988		cpu_base = &per_cpu(hrtimer_bases, cpu);
 989		raw_spin_lock_irqsave(&cpu_base->lock, flags);
 990
 991		if (update_needs_ipi(cpu_base, bases))
 992			cpumask_set_cpu(cpu, mask);
 993
 994		raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
 995	}
 996
 997	preempt_disable();
 998	smp_call_function_many(mask, retrigger_next_event, NULL, 1);
 999	preempt_enable();
1000	cpus_read_unlock();
1001	free_cpumask_var(mask);
1002
1003out_timerfd:
1004	timerfd_clock_was_set();
1005}
1006
1007static void clock_was_set_work(struct work_struct *work)
1008{
1009	clock_was_set(CLOCK_SET_WALL);
1010}
1011
1012static DECLARE_WORK(hrtimer_work, clock_was_set_work);
1013
1014/*
1015 * Called from timekeeping code to reprogram the hrtimer interrupt device
1016 * on all cpus and to notify timerfd.
1017 */
1018void clock_was_set_delayed(void)
1019{
1020	schedule_work(&hrtimer_work);
1021}
1022
1023/*
1024 * Called during resume either directly from via timekeeping_resume()
1025 * or in the case of s2idle from tick_unfreeze() to ensure that the
1026 * hrtimers are up to date.
 
1027 */
1028void hrtimers_resume_local(void)
1029{
1030	lockdep_assert_irqs_disabled();
1031	/* Retrigger on the local CPU */
1032	retrigger_next_event(NULL);
 
 
1033}
1034
1035/*
1036 * Counterpart to lock_hrtimer_base above:
1037 */
1038static inline
1039void unlock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
1040	__releases(&timer->base->cpu_base->lock)
1041{
1042	raw_spin_unlock_irqrestore(&timer->base->cpu_base->lock, *flags);
1043}
1044
1045/**
1046 * hrtimer_forward() - forward the timer expiry
1047 * @timer:	hrtimer to forward
1048 * @now:	forward past this time
1049 * @interval:	the interval to forward
1050 *
1051 * Forward the timer expiry so it will expire in the future.
 
1052 *
1053 * .. note::
1054 *  This only updates the timer expiry value and does not requeue the timer.
 
 
1055 *
1056 * There is also a variant of the function hrtimer_forward_now().
1057 *
1058 * Context: Can be safely called from the callback function of @timer. If called
1059 *          from other contexts @timer must neither be enqueued nor running the
1060 *          callback and the caller needs to take care of serialization.
1061 *
1062 * Return: The number of overruns are returned.
1063 */
1064u64 hrtimer_forward(struct hrtimer *timer, ktime_t now, ktime_t interval)
1065{
1066	u64 orun = 1;
1067	ktime_t delta;
1068
1069	delta = ktime_sub(now, hrtimer_get_expires(timer));
1070
1071	if (delta < 0)
1072		return 0;
1073
1074	if (WARN_ON(timer->state & HRTIMER_STATE_ENQUEUED))
1075		return 0;
1076
1077	if (interval < hrtimer_resolution)
1078		interval = hrtimer_resolution;
1079
1080	if (unlikely(delta >= interval)) {
1081		s64 incr = ktime_to_ns(interval);
1082
1083		orun = ktime_divns(delta, incr);
1084		hrtimer_add_expires_ns(timer, incr * orun);
1085		if (hrtimer_get_expires_tv64(timer) > now)
1086			return orun;
1087		/*
1088		 * This (and the ktime_add() below) is the
1089		 * correction for exact:
1090		 */
1091		orun++;
1092	}
1093	hrtimer_add_expires(timer, interval);
1094
1095	return orun;
1096}
1097EXPORT_SYMBOL_GPL(hrtimer_forward);
1098
1099/*
1100 * enqueue_hrtimer - internal function to (re)start a timer
1101 *
1102 * The timer is inserted in expiry order. Insertion into the
1103 * red black tree is O(log(n)). Must hold the base lock.
1104 *
1105 * Returns 1 when the new timer is the leftmost timer in the tree.
1106 */
1107static int enqueue_hrtimer(struct hrtimer *timer,
1108			   struct hrtimer_clock_base *base,
1109			   enum hrtimer_mode mode)
1110{
1111	debug_activate(timer, mode);
1112	WARN_ON_ONCE(!base->cpu_base->online);
1113
1114	base->cpu_base->active_bases |= 1 << base->index;
1115
1116	/* Pairs with the lockless read in hrtimer_is_queued() */
1117	WRITE_ONCE(timer->state, HRTIMER_STATE_ENQUEUED);
1118
1119	return timerqueue_add(&base->active, &timer->node);
1120}
1121
1122/*
1123 * __remove_hrtimer - internal function to remove a timer
1124 *
1125 * Caller must hold the base lock.
1126 *
1127 * High resolution timer mode reprograms the clock event device when the
1128 * timer is the one which expires next. The caller can disable this by setting
1129 * reprogram to zero. This is useful, when the context does a reprogramming
1130 * anyway (e.g. timer interrupt)
1131 */
1132static void __remove_hrtimer(struct hrtimer *timer,
1133			     struct hrtimer_clock_base *base,
1134			     u8 newstate, int reprogram)
1135{
1136	struct hrtimer_cpu_base *cpu_base = base->cpu_base;
1137	u8 state = timer->state;
1138
1139	/* Pairs with the lockless read in hrtimer_is_queued() */
1140	WRITE_ONCE(timer->state, newstate);
1141	if (!(state & HRTIMER_STATE_ENQUEUED))
1142		return;
1143
1144	if (!timerqueue_del(&base->active, &timer->node))
1145		cpu_base->active_bases &= ~(1 << base->index);
1146
1147	/*
1148	 * Note: If reprogram is false we do not update
1149	 * cpu_base->next_timer. This happens when we remove the first
1150	 * timer on a remote cpu. No harm as we never dereference
1151	 * cpu_base->next_timer. So the worst thing what can happen is
1152	 * an superfluous call to hrtimer_force_reprogram() on the
1153	 * remote cpu later on if the same timer gets enqueued again.
1154	 */
1155	if (reprogram && timer == cpu_base->next_timer)
1156		hrtimer_force_reprogram(cpu_base, 1);
1157}
1158
1159/*
1160 * remove hrtimer, called with base lock held
1161 */
1162static inline int
1163remove_hrtimer(struct hrtimer *timer, struct hrtimer_clock_base *base,
1164	       bool restart, bool keep_local)
1165{
1166	u8 state = timer->state;
1167
1168	if (state & HRTIMER_STATE_ENQUEUED) {
1169		bool reprogram;
1170
1171		/*
1172		 * Remove the timer and force reprogramming when high
1173		 * resolution mode is active and the timer is on the current
1174		 * CPU. If we remove a timer on another CPU, reprogramming is
1175		 * skipped. The interrupt event on this CPU is fired and
1176		 * reprogramming happens in the interrupt handler. This is a
1177		 * rare case and less expensive than a smp call.
1178		 */
1179		debug_deactivate(timer);
1180		reprogram = base->cpu_base == this_cpu_ptr(&hrtimer_bases);
1181
1182		/*
1183		 * If the timer is not restarted then reprogramming is
1184		 * required if the timer is local. If it is local and about
1185		 * to be restarted, avoid programming it twice (on removal
1186		 * and a moment later when it's requeued).
1187		 */
1188		if (!restart)
1189			state = HRTIMER_STATE_INACTIVE;
1190		else
1191			reprogram &= !keep_local;
1192
1193		__remove_hrtimer(timer, base, state, reprogram);
1194		return 1;
1195	}
1196	return 0;
1197}
1198
1199static inline ktime_t hrtimer_update_lowres(struct hrtimer *timer, ktime_t tim,
1200					    const enum hrtimer_mode mode)
1201{
1202#ifdef CONFIG_TIME_LOW_RES
1203	/*
1204	 * CONFIG_TIME_LOW_RES indicates that the system has no way to return
1205	 * granular time values. For relative timers we add hrtimer_resolution
1206	 * (i.e. one jiffy) to prevent short timeouts.
1207	 */
1208	timer->is_rel = mode & HRTIMER_MODE_REL;
1209	if (timer->is_rel)
1210		tim = ktime_add_safe(tim, hrtimer_resolution);
1211#endif
1212	return tim;
1213}
1214
1215static void
1216hrtimer_update_softirq_timer(struct hrtimer_cpu_base *cpu_base, bool reprogram)
1217{
1218	ktime_t expires;
1219
1220	/*
1221	 * Find the next SOFT expiration.
1222	 */
1223	expires = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_SOFT);
1224
1225	/*
1226	 * reprogramming needs to be triggered, even if the next soft
1227	 * hrtimer expires at the same time than the next hard
1228	 * hrtimer. cpu_base->softirq_expires_next needs to be updated!
1229	 */
1230	if (expires == KTIME_MAX)
1231		return;
1232
1233	/*
1234	 * cpu_base->*next_timer is recomputed by __hrtimer_get_next_event()
1235	 * cpu_base->*expires_next is only set by hrtimer_reprogram()
1236	 */
1237	hrtimer_reprogram(cpu_base->softirq_next_timer, reprogram);
1238}
1239
1240static int __hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
1241				    u64 delta_ns, const enum hrtimer_mode mode,
1242				    struct hrtimer_clock_base *base)
1243{
1244	struct hrtimer_cpu_base *this_cpu_base = this_cpu_ptr(&hrtimer_bases);
1245	struct hrtimer_clock_base *new_base;
1246	bool force_local, first;
1247
1248	/*
1249	 * If the timer is on the local cpu base and is the first expiring
1250	 * timer then this might end up reprogramming the hardware twice
1251	 * (on removal and on enqueue). To avoid that by prevent the
1252	 * reprogram on removal, keep the timer local to the current CPU
1253	 * and enforce reprogramming after it is queued no matter whether
1254	 * it is the new first expiring timer again or not.
1255	 */
1256	force_local = base->cpu_base == this_cpu_base;
1257	force_local &= base->cpu_base->next_timer == timer;
1258
1259	/*
1260	 * Don't force local queuing if this enqueue happens on a unplugged
1261	 * CPU after hrtimer_cpu_dying() has been invoked.
1262	 */
1263	force_local &= this_cpu_base->online;
1264
1265	/*
1266	 * Remove an active timer from the queue. In case it is not queued
1267	 * on the current CPU, make sure that remove_hrtimer() updates the
1268	 * remote data correctly.
1269	 *
1270	 * If it's on the current CPU and the first expiring timer, then
1271	 * skip reprogramming, keep the timer local and enforce
1272	 * reprogramming later if it was the first expiring timer.  This
1273	 * avoids programming the underlying clock event twice (once at
1274	 * removal and once after enqueue).
1275	 */
1276	remove_hrtimer(timer, base, true, force_local);
1277
1278	if (mode & HRTIMER_MODE_REL)
1279		tim = ktime_add_safe(tim, base->get_time());
1280
1281	tim = hrtimer_update_lowres(timer, tim, mode);
1282
1283	hrtimer_set_expires_range_ns(timer, tim, delta_ns);
1284
1285	/* Switch the timer base, if necessary: */
1286	if (!force_local) {
1287		new_base = switch_hrtimer_base(timer, base,
1288					       mode & HRTIMER_MODE_PINNED);
1289	} else {
1290		new_base = base;
1291	}
1292
1293	first = enqueue_hrtimer(timer, new_base, mode);
1294	if (!force_local) {
1295		/*
1296		 * If the current CPU base is online, then the timer is
1297		 * never queued on a remote CPU if it would be the first
1298		 * expiring timer there.
1299		 */
1300		if (hrtimer_base_is_online(this_cpu_base))
1301			return first;
1302
1303		/*
1304		 * Timer was enqueued remote because the current base is
1305		 * already offline. If the timer is the first to expire,
1306		 * kick the remote CPU to reprogram the clock event.
1307		 */
1308		if (first) {
1309			struct hrtimer_cpu_base *new_cpu_base = new_base->cpu_base;
1310
1311			smp_call_function_single_async(new_cpu_base->cpu, &new_cpu_base->csd);
1312		}
1313		return 0;
1314	}
1315
1316	/*
1317	 * Timer was forced to stay on the current CPU to avoid
1318	 * reprogramming on removal and enqueue. Force reprogram the
1319	 * hardware by evaluating the new first expiring timer.
1320	 */
1321	hrtimer_force_reprogram(new_base->cpu_base, 1);
1322	return 0;
1323}
1324
1325/**
1326 * hrtimer_start_range_ns - (re)start an hrtimer
1327 * @timer:	the timer to be added
1328 * @tim:	expiry time
1329 * @delta_ns:	"slack" range for the timer
1330 * @mode:	timer mode: absolute (HRTIMER_MODE_ABS) or
1331 *		relative (HRTIMER_MODE_REL), and pinned (HRTIMER_MODE_PINNED);
1332 *		softirq based mode is considered for debug purpose only!
1333 */
1334void hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
1335			    u64 delta_ns, const enum hrtimer_mode mode)
1336{
1337	struct hrtimer_clock_base *base;
1338	unsigned long flags;
1339
1340	if (WARN_ON_ONCE(!timer->function))
1341		return;
1342	/*
1343	 * Check whether the HRTIMER_MODE_SOFT bit and hrtimer.is_soft
1344	 * match on CONFIG_PREEMPT_RT = n. With PREEMPT_RT check the hard
1345	 * expiry mode because unmarked timers are moved to softirq expiry.
1346	 */
1347	if (!IS_ENABLED(CONFIG_PREEMPT_RT))
1348		WARN_ON_ONCE(!(mode & HRTIMER_MODE_SOFT) ^ !timer->is_soft);
1349	else
1350		WARN_ON_ONCE(!(mode & HRTIMER_MODE_HARD) ^ !timer->is_hard);
1351
1352	base = lock_hrtimer_base(timer, &flags);
1353
1354	if (__hrtimer_start_range_ns(timer, tim, delta_ns, mode, base))
1355		hrtimer_reprogram(timer, true);
1356
1357	unlock_hrtimer_base(timer, &flags);
1358}
1359EXPORT_SYMBOL_GPL(hrtimer_start_range_ns);
1360
1361/**
1362 * hrtimer_try_to_cancel - try to deactivate a timer
1363 * @timer:	hrtimer to stop
1364 *
1365 * Returns:
1366 *
1367 *  *  0 when the timer was not active
1368 *  *  1 when the timer was active
1369 *  * -1 when the timer is currently executing the callback function and
1370 *    cannot be stopped
1371 */
1372int hrtimer_try_to_cancel(struct hrtimer *timer)
1373{
1374	struct hrtimer_clock_base *base;
1375	unsigned long flags;
1376	int ret = -1;
1377
1378	/*
1379	 * Check lockless first. If the timer is not active (neither
1380	 * enqueued nor running the callback, nothing to do here.  The
1381	 * base lock does not serialize against a concurrent enqueue,
1382	 * so we can avoid taking it.
1383	 */
1384	if (!hrtimer_active(timer))
1385		return 0;
1386
1387	base = lock_hrtimer_base(timer, &flags);
1388
1389	if (!hrtimer_callback_running(timer))
1390		ret = remove_hrtimer(timer, base, false, false);
1391
1392	unlock_hrtimer_base(timer, &flags);
1393
1394	return ret;
1395
1396}
1397EXPORT_SYMBOL_GPL(hrtimer_try_to_cancel);
1398
1399#ifdef CONFIG_PREEMPT_RT
1400static void hrtimer_cpu_base_init_expiry_lock(struct hrtimer_cpu_base *base)
1401{
1402	spin_lock_init(&base->softirq_expiry_lock);
1403}
1404
1405static void hrtimer_cpu_base_lock_expiry(struct hrtimer_cpu_base *base)
1406	__acquires(&base->softirq_expiry_lock)
1407{
1408	spin_lock(&base->softirq_expiry_lock);
1409}
1410
1411static void hrtimer_cpu_base_unlock_expiry(struct hrtimer_cpu_base *base)
1412	__releases(&base->softirq_expiry_lock)
1413{
1414	spin_unlock(&base->softirq_expiry_lock);
1415}
1416
1417/*
1418 * The counterpart to hrtimer_cancel_wait_running().
1419 *
1420 * If there is a waiter for cpu_base->expiry_lock, then it was waiting for
1421 * the timer callback to finish. Drop expiry_lock and reacquire it. That
1422 * allows the waiter to acquire the lock and make progress.
1423 */
1424static void hrtimer_sync_wait_running(struct hrtimer_cpu_base *cpu_base,
1425				      unsigned long flags)
1426{
1427	if (atomic_read(&cpu_base->timer_waiters)) {
1428		raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1429		spin_unlock(&cpu_base->softirq_expiry_lock);
1430		spin_lock(&cpu_base->softirq_expiry_lock);
1431		raw_spin_lock_irq(&cpu_base->lock);
1432	}
1433}
1434
1435/*
1436 * This function is called on PREEMPT_RT kernels when the fast path
1437 * deletion of a timer failed because the timer callback function was
1438 * running.
1439 *
1440 * This prevents priority inversion: if the soft irq thread is preempted
1441 * in the middle of a timer callback, then calling del_timer_sync() can
1442 * lead to two issues:
1443 *
1444 *  - If the caller is on a remote CPU then it has to spin wait for the timer
1445 *    handler to complete. This can result in unbound priority inversion.
1446 *
1447 *  - If the caller originates from the task which preempted the timer
1448 *    handler on the same CPU, then spin waiting for the timer handler to
1449 *    complete is never going to end.
1450 */
1451void hrtimer_cancel_wait_running(const struct hrtimer *timer)
1452{
1453	/* Lockless read. Prevent the compiler from reloading it below */
1454	struct hrtimer_clock_base *base = READ_ONCE(timer->base);
1455
1456	/*
1457	 * Just relax if the timer expires in hard interrupt context or if
1458	 * it is currently on the migration base.
1459	 */
1460	if (!timer->is_soft || is_migration_base(base)) {
1461		cpu_relax();
1462		return;
1463	}
1464
1465	/*
1466	 * Mark the base as contended and grab the expiry lock, which is
1467	 * held by the softirq across the timer callback. Drop the lock
1468	 * immediately so the softirq can expire the next timer. In theory
1469	 * the timer could already be running again, but that's more than
1470	 * unlikely and just causes another wait loop.
1471	 */
1472	atomic_inc(&base->cpu_base->timer_waiters);
1473	spin_lock_bh(&base->cpu_base->softirq_expiry_lock);
1474	atomic_dec(&base->cpu_base->timer_waiters);
1475	spin_unlock_bh(&base->cpu_base->softirq_expiry_lock);
1476}
1477#else
1478static inline void
1479hrtimer_cpu_base_init_expiry_lock(struct hrtimer_cpu_base *base) { }
1480static inline void
1481hrtimer_cpu_base_lock_expiry(struct hrtimer_cpu_base *base) { }
1482static inline void
1483hrtimer_cpu_base_unlock_expiry(struct hrtimer_cpu_base *base) { }
1484static inline void hrtimer_sync_wait_running(struct hrtimer_cpu_base *base,
1485					     unsigned long flags) { }
1486#endif
1487
1488/**
1489 * hrtimer_cancel - cancel a timer and wait for the handler to finish.
1490 * @timer:	the timer to be cancelled
1491 *
1492 * Returns:
1493 *  0 when the timer was not active
1494 *  1 when the timer was active
1495 */
1496int hrtimer_cancel(struct hrtimer *timer)
1497{
1498	int ret;
 
1499
1500	do {
1501		ret = hrtimer_try_to_cancel(timer);
1502
1503		if (ret < 0)
1504			hrtimer_cancel_wait_running(timer);
1505	} while (ret < 0);
1506	return ret;
1507}
1508EXPORT_SYMBOL_GPL(hrtimer_cancel);
1509
1510/**
1511 * __hrtimer_get_remaining - get remaining time for the timer
1512 * @timer:	the timer to read
1513 * @adjust:	adjust relative timers when CONFIG_TIME_LOW_RES=y
1514 */
1515ktime_t __hrtimer_get_remaining(const struct hrtimer *timer, bool adjust)
1516{
1517	unsigned long flags;
1518	ktime_t rem;
1519
1520	lock_hrtimer_base(timer, &flags);
1521	if (IS_ENABLED(CONFIG_TIME_LOW_RES) && adjust)
1522		rem = hrtimer_expires_remaining_adjusted(timer);
1523	else
1524		rem = hrtimer_expires_remaining(timer);
1525	unlock_hrtimer_base(timer, &flags);
1526
1527	return rem;
1528}
1529EXPORT_SYMBOL_GPL(__hrtimer_get_remaining);
1530
1531#ifdef CONFIG_NO_HZ_COMMON
1532/**
1533 * hrtimer_get_next_event - get the time until next expiry event
1534 *
1535 * Returns the next expiry time or KTIME_MAX if no timer is pending.
1536 */
1537u64 hrtimer_get_next_event(void)
1538{
1539	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1540	u64 expires = KTIME_MAX;
1541	unsigned long flags;
1542
1543	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1544
1545	if (!hrtimer_hres_active(cpu_base))
1546		expires = __hrtimer_get_next_event(cpu_base, HRTIMER_ACTIVE_ALL);
1547
1548	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1549
1550	return expires;
1551}
1552
1553/**
1554 * hrtimer_next_event_without - time until next expiry event w/o one timer
1555 * @exclude:	timer to exclude
1556 *
1557 * Returns the next expiry time over all timers except for the @exclude one or
1558 * KTIME_MAX if none of them is pending.
1559 */
1560u64 hrtimer_next_event_without(const struct hrtimer *exclude)
1561{
1562	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1563	u64 expires = KTIME_MAX;
1564	unsigned long flags;
1565
1566	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1567
1568	if (hrtimer_hres_active(cpu_base)) {
1569		unsigned int active;
1570
1571		if (!cpu_base->softirq_activated) {
1572			active = cpu_base->active_bases & HRTIMER_ACTIVE_SOFT;
1573			expires = __hrtimer_next_event_base(cpu_base, exclude,
1574							    active, KTIME_MAX);
1575		}
1576		active = cpu_base->active_bases & HRTIMER_ACTIVE_HARD;
1577		expires = __hrtimer_next_event_base(cpu_base, exclude, active,
1578						    expires);
1579	}
1580
1581	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1582
1583	return expires;
1584}
1585#endif
1586
1587static inline int hrtimer_clockid_to_base(clockid_t clock_id)
1588{
1589	if (likely(clock_id < MAX_CLOCKS)) {
1590		int base = hrtimer_clock_to_base_table[clock_id];
1591
1592		if (likely(base != HRTIMER_MAX_CLOCK_BASES))
1593			return base;
1594	}
1595	WARN(1, "Invalid clockid %d. Using MONOTONIC\n", clock_id);
1596	return HRTIMER_BASE_MONOTONIC;
1597}
1598
1599static enum hrtimer_restart hrtimer_dummy_timeout(struct hrtimer *unused)
1600{
1601	return HRTIMER_NORESTART;
1602}
1603
1604static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
1605			   enum hrtimer_mode mode)
1606{
1607	bool softtimer = !!(mode & HRTIMER_MODE_SOFT);
 
1608	struct hrtimer_cpu_base *cpu_base;
1609	int base;
1610
1611	/*
1612	 * On PREEMPT_RT enabled kernels hrtimers which are not explicitly
1613	 * marked for hard interrupt expiry mode are moved into soft
1614	 * interrupt context for latency reasons and because the callbacks
1615	 * can invoke functions which might sleep on RT, e.g. spin_lock().
1616	 */
1617	if (IS_ENABLED(CONFIG_PREEMPT_RT) && !(mode & HRTIMER_MODE_HARD))
1618		softtimer = true;
1619
1620	memset(timer, 0, sizeof(struct hrtimer));
1621
1622	cpu_base = raw_cpu_ptr(&hrtimer_bases);
1623
1624	/*
1625	 * POSIX magic: Relative CLOCK_REALTIME timers are not affected by
1626	 * clock modifications, so they needs to become CLOCK_MONOTONIC to
1627	 * ensure POSIX compliance.
1628	 */
1629	if (clock_id == CLOCK_REALTIME && mode & HRTIMER_MODE_REL)
1630		clock_id = CLOCK_MONOTONIC;
1631
1632	base = softtimer ? HRTIMER_MAX_CLOCK_BASES / 2 : 0;
1633	base += hrtimer_clockid_to_base(clock_id);
1634	timer->is_soft = softtimer;
1635	timer->is_hard = !!(mode & HRTIMER_MODE_HARD);
1636	timer->base = &cpu_base->clock_base[base];
1637	timerqueue_init(&timer->node);
1638}
1639
1640static void __hrtimer_setup(struct hrtimer *timer,
1641			    enum hrtimer_restart (*function)(struct hrtimer *),
1642			    clockid_t clock_id, enum hrtimer_mode mode)
1643{
1644	__hrtimer_init(timer, clock_id, mode);
1645
1646	if (WARN_ON_ONCE(!function))
1647		timer->function = hrtimer_dummy_timeout;
1648	else
1649		timer->function = function;
1650}
1651
1652/**
1653 * hrtimer_init - initialize a timer to the given clock
1654 * @timer:	the timer to be initialized
1655 * @clock_id:	the clock to be used
1656 * @mode:       The modes which are relevant for initialization:
1657 *              HRTIMER_MODE_ABS, HRTIMER_MODE_REL, HRTIMER_MODE_ABS_SOFT,
1658 *              HRTIMER_MODE_REL_SOFT
1659 *
1660 *              The PINNED variants of the above can be handed in,
1661 *              but the PINNED bit is ignored as pinning happens
1662 *              when the hrtimer is started
1663 */
1664void hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
1665		  enum hrtimer_mode mode)
1666{
1667	debug_init(timer, clock_id, mode);
1668	__hrtimer_init(timer, clock_id, mode);
1669}
1670EXPORT_SYMBOL_GPL(hrtimer_init);
1671
1672/**
1673 * hrtimer_setup - initialize a timer to the given clock
1674 * @timer:	the timer to be initialized
1675 * @function:	the callback function
1676 * @clock_id:	the clock to be used
1677 * @mode:       The modes which are relevant for initialization:
1678 *              HRTIMER_MODE_ABS, HRTIMER_MODE_REL, HRTIMER_MODE_ABS_SOFT,
1679 *              HRTIMER_MODE_REL_SOFT
1680 *
1681 *              The PINNED variants of the above can be handed in,
1682 *              but the PINNED bit is ignored as pinning happens
1683 *              when the hrtimer is started
1684 */
1685void hrtimer_setup(struct hrtimer *timer, enum hrtimer_restart (*function)(struct hrtimer *),
1686		   clockid_t clock_id, enum hrtimer_mode mode)
1687{
1688	debug_init(timer, clock_id, mode);
1689	__hrtimer_setup(timer, function, clock_id, mode);
1690}
1691EXPORT_SYMBOL_GPL(hrtimer_setup);
1692
1693/**
1694 * hrtimer_setup_on_stack - initialize a timer on stack memory
1695 * @timer:	The timer to be initialized
1696 * @function:	the callback function
1697 * @clock_id:	The clock to be used
1698 * @mode:       The timer mode
1699 *
1700 * Similar to hrtimer_setup(), except that this one must be used if struct hrtimer is in stack
1701 * memory.
1702 */
1703void hrtimer_setup_on_stack(struct hrtimer *timer,
1704			    enum hrtimer_restart (*function)(struct hrtimer *),
1705			    clockid_t clock_id, enum hrtimer_mode mode)
1706{
1707	debug_init_on_stack(timer, clock_id, mode);
1708	__hrtimer_setup(timer, function, clock_id, mode);
1709}
1710EXPORT_SYMBOL_GPL(hrtimer_setup_on_stack);
1711
1712/*
1713 * A timer is active, when it is enqueued into the rbtree or the
1714 * callback function is running or it's in the state of being migrated
1715 * to another cpu.
1716 *
1717 * It is important for this function to not return a false negative.
1718 */
1719bool hrtimer_active(const struct hrtimer *timer)
1720{
1721	struct hrtimer_clock_base *base;
1722	unsigned int seq;
1723
1724	do {
1725		base = READ_ONCE(timer->base);
1726		seq = raw_read_seqcount_begin(&base->seq);
1727
1728		if (timer->state != HRTIMER_STATE_INACTIVE ||
1729		    base->running == timer)
1730			return true;
1731
1732	} while (read_seqcount_retry(&base->seq, seq) ||
1733		 base != READ_ONCE(timer->base));
1734
1735	return false;
1736}
1737EXPORT_SYMBOL_GPL(hrtimer_active);
1738
1739/*
1740 * The write_seqcount_barrier()s in __run_hrtimer() split the thing into 3
1741 * distinct sections:
1742 *
1743 *  - queued:	the timer is queued
1744 *  - callback:	the timer is being ran
1745 *  - post:	the timer is inactive or (re)queued
1746 *
1747 * On the read side we ensure we observe timer->state and cpu_base->running
1748 * from the same section, if anything changed while we looked at it, we retry.
1749 * This includes timer->base changing because sequence numbers alone are
1750 * insufficient for that.
1751 *
1752 * The sequence numbers are required because otherwise we could still observe
1753 * a false negative if the read side got smeared over multiple consecutive
1754 * __run_hrtimer() invocations.
1755 */
1756
1757static void __run_hrtimer(struct hrtimer_cpu_base *cpu_base,
1758			  struct hrtimer_clock_base *base,
1759			  struct hrtimer *timer, ktime_t *now,
1760			  unsigned long flags) __must_hold(&cpu_base->lock)
1761{
1762	enum hrtimer_restart (*fn)(struct hrtimer *);
1763	bool expires_in_hardirq;
1764	int restart;
1765
1766	lockdep_assert_held(&cpu_base->lock);
1767
1768	debug_deactivate(timer);
1769	base->running = timer;
1770
1771	/*
1772	 * Separate the ->running assignment from the ->state assignment.
1773	 *
1774	 * As with a regular write barrier, this ensures the read side in
1775	 * hrtimer_active() cannot observe base->running == NULL &&
1776	 * timer->state == INACTIVE.
1777	 */
1778	raw_write_seqcount_barrier(&base->seq);
1779
1780	__remove_hrtimer(timer, base, HRTIMER_STATE_INACTIVE, 0);
1781	fn = timer->function;
1782
1783	/*
1784	 * Clear the 'is relative' flag for the TIME_LOW_RES case. If the
1785	 * timer is restarted with a period then it becomes an absolute
1786	 * timer. If its not restarted it does not matter.
1787	 */
1788	if (IS_ENABLED(CONFIG_TIME_LOW_RES))
1789		timer->is_rel = false;
1790
1791	/*
1792	 * The timer is marked as running in the CPU base, so it is
1793	 * protected against migration to a different CPU even if the lock
1794	 * is dropped.
1795	 */
1796	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1797	trace_hrtimer_expire_entry(timer, now);
1798	expires_in_hardirq = lockdep_hrtimer_enter(timer);
1799
1800	restart = fn(timer);
1801
1802	lockdep_hrtimer_exit(expires_in_hardirq);
1803	trace_hrtimer_expire_exit(timer);
1804	raw_spin_lock_irq(&cpu_base->lock);
1805
1806	/*
1807	 * Note: We clear the running state after enqueue_hrtimer and
1808	 * we do not reprogram the event hardware. Happens either in
1809	 * hrtimer_start_range_ns() or in hrtimer_interrupt()
1810	 *
1811	 * Note: Because we dropped the cpu_base->lock above,
1812	 * hrtimer_start_range_ns() can have popped in and enqueued the timer
1813	 * for us already.
1814	 */
1815	if (restart != HRTIMER_NORESTART &&
1816	    !(timer->state & HRTIMER_STATE_ENQUEUED))
1817		enqueue_hrtimer(timer, base, HRTIMER_MODE_ABS);
1818
1819	/*
1820	 * Separate the ->running assignment from the ->state assignment.
1821	 *
1822	 * As with a regular write barrier, this ensures the read side in
1823	 * hrtimer_active() cannot observe base->running.timer == NULL &&
1824	 * timer->state == INACTIVE.
1825	 */
1826	raw_write_seqcount_barrier(&base->seq);
1827
1828	WARN_ON_ONCE(base->running != timer);
1829	base->running = NULL;
1830}
1831
1832static void __hrtimer_run_queues(struct hrtimer_cpu_base *cpu_base, ktime_t now,
1833				 unsigned long flags, unsigned int active_mask)
1834{
1835	struct hrtimer_clock_base *base;
1836	unsigned int active = cpu_base->active_bases & active_mask;
1837
1838	for_each_active_base(base, cpu_base, active) {
1839		struct timerqueue_node *node;
1840		ktime_t basenow;
1841
1842		basenow = ktime_add(now, base->offset);
1843
1844		while ((node = timerqueue_getnext(&base->active))) {
1845			struct hrtimer *timer;
1846
1847			timer = container_of(node, struct hrtimer, node);
1848
1849			/*
1850			 * The immediate goal for using the softexpires is
1851			 * minimizing wakeups, not running timers at the
1852			 * earliest interrupt after their soft expiration.
1853			 * This allows us to avoid using a Priority Search
1854			 * Tree, which can answer a stabbing query for
1855			 * overlapping intervals and instead use the simple
1856			 * BST we already have.
1857			 * We don't add extra wakeups by delaying timers that
1858			 * are right-of a not yet expired timer, because that
1859			 * timer will have to trigger a wakeup anyway.
1860			 */
1861			if (basenow < hrtimer_get_softexpires_tv64(timer))
1862				break;
1863
1864			__run_hrtimer(cpu_base, base, timer, &basenow, flags);
1865			if (active_mask == HRTIMER_ACTIVE_SOFT)
1866				hrtimer_sync_wait_running(cpu_base, flags);
1867		}
1868	}
1869}
1870
1871static __latent_entropy void hrtimer_run_softirq(void)
1872{
1873	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1874	unsigned long flags;
1875	ktime_t now;
1876
1877	hrtimer_cpu_base_lock_expiry(cpu_base);
1878	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1879
1880	now = hrtimer_update_base(cpu_base);
1881	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_SOFT);
1882
1883	cpu_base->softirq_activated = 0;
1884	hrtimer_update_softirq_timer(cpu_base, true);
1885
1886	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1887	hrtimer_cpu_base_unlock_expiry(cpu_base);
1888}
1889
1890#ifdef CONFIG_HIGH_RES_TIMERS
1891
1892/*
1893 * High resolution timer interrupt
1894 * Called with interrupts disabled
1895 */
1896void hrtimer_interrupt(struct clock_event_device *dev)
1897{
1898	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1899	ktime_t expires_next, now, entry_time, delta;
1900	unsigned long flags;
1901	int retries = 0;
1902
1903	BUG_ON(!cpu_base->hres_active);
1904	cpu_base->nr_events++;
1905	dev->next_event = KTIME_MAX;
1906
1907	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1908	entry_time = now = hrtimer_update_base(cpu_base);
1909retry:
1910	cpu_base->in_hrtirq = 1;
1911	/*
1912	 * We set expires_next to KTIME_MAX here with cpu_base->lock
1913	 * held to prevent that a timer is enqueued in our queue via
1914	 * the migration code. This does not affect enqueueing of
1915	 * timers which run their callback and need to be requeued on
1916	 * this CPU.
1917	 */
1918	cpu_base->expires_next = KTIME_MAX;
1919
1920	if (!ktime_before(now, cpu_base->softirq_expires_next)) {
1921		cpu_base->softirq_expires_next = KTIME_MAX;
1922		cpu_base->softirq_activated = 1;
1923		raise_timer_softirq(HRTIMER_SOFTIRQ);
1924	}
1925
1926	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_HARD);
1927
1928	/* Reevaluate the clock bases for the [soft] next expiry */
1929	expires_next = hrtimer_update_next_event(cpu_base);
1930	/*
1931	 * Store the new expiry value so the migration code can verify
1932	 * against it.
1933	 */
1934	cpu_base->expires_next = expires_next;
1935	cpu_base->in_hrtirq = 0;
1936	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1937
1938	/* Reprogramming necessary ? */
1939	if (!tick_program_event(expires_next, 0)) {
1940		cpu_base->hang_detected = 0;
1941		return;
1942	}
1943
1944	/*
1945	 * The next timer was already expired due to:
1946	 * - tracing
1947	 * - long lasting callbacks
1948	 * - being scheduled away when running in a VM
1949	 *
1950	 * We need to prevent that we loop forever in the hrtimer
1951	 * interrupt routine. We give it 3 attempts to avoid
1952	 * overreacting on some spurious event.
1953	 *
1954	 * Acquire base lock for updating the offsets and retrieving
1955	 * the current time.
1956	 */
1957	raw_spin_lock_irqsave(&cpu_base->lock, flags);
1958	now = hrtimer_update_base(cpu_base);
1959	cpu_base->nr_retries++;
1960	if (++retries < 3)
1961		goto retry;
1962	/*
1963	 * Give the system a chance to do something else than looping
1964	 * here. We stored the entry time, so we know exactly how long
1965	 * we spent here. We schedule the next event this amount of
1966	 * time away.
1967	 */
1968	cpu_base->nr_hangs++;
1969	cpu_base->hang_detected = 1;
1970	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
1971
1972	delta = ktime_sub(now, entry_time);
1973	if ((unsigned int)delta > cpu_base->max_hang_time)
1974		cpu_base->max_hang_time = (unsigned int) delta;
1975	/*
1976	 * Limit it to a sensible value as we enforce a longer
1977	 * delay. Give the CPU at least 100ms to catch up.
1978	 */
1979	if (delta > 100 * NSEC_PER_MSEC)
1980		expires_next = ktime_add_ns(now, 100 * NSEC_PER_MSEC);
1981	else
1982		expires_next = ktime_add(now, delta);
1983	tick_program_event(expires_next, 1);
1984	pr_warn_once("hrtimer: interrupt took %llu ns\n", ktime_to_ns(delta));
 
1985}
1986#endif /* !CONFIG_HIGH_RES_TIMERS */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1987
1988/*
1989 * Called from run_local_timers in hardirq context every jiffy
1990 */
1991void hrtimer_run_queues(void)
1992{
1993	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1994	unsigned long flags;
1995	ktime_t now;
1996
1997	if (hrtimer_hres_active(cpu_base))
1998		return;
1999
2000	/*
2001	 * This _is_ ugly: We have to check periodically, whether we
2002	 * can switch to highres and / or nohz mode. The clocksource
2003	 * switch happens with xtime_lock held. Notification from
2004	 * there only sets the check bit in the tick_oneshot code,
2005	 * otherwise we might deadlock vs. xtime_lock.
2006	 */
2007	if (tick_check_oneshot_change(!hrtimer_is_hres_enabled())) {
2008		hrtimer_switch_to_hres();
2009		return;
2010	}
2011
2012	raw_spin_lock_irqsave(&cpu_base->lock, flags);
2013	now = hrtimer_update_base(cpu_base);
2014
2015	if (!ktime_before(now, cpu_base->softirq_expires_next)) {
2016		cpu_base->softirq_expires_next = KTIME_MAX;
2017		cpu_base->softirq_activated = 1;
2018		raise_timer_softirq(HRTIMER_SOFTIRQ);
2019	}
2020
2021	__hrtimer_run_queues(cpu_base, now, flags, HRTIMER_ACTIVE_HARD);
2022	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
2023}
2024
2025/*
2026 * Sleep related functions:
2027 */
2028static enum hrtimer_restart hrtimer_wakeup(struct hrtimer *timer)
2029{
2030	struct hrtimer_sleeper *t =
2031		container_of(timer, struct hrtimer_sleeper, timer);
2032	struct task_struct *task = t->task;
2033
2034	t->task = NULL;
2035	if (task)
2036		wake_up_process(task);
2037
2038	return HRTIMER_NORESTART;
2039}
2040
2041/**
2042 * hrtimer_sleeper_start_expires - Start a hrtimer sleeper timer
2043 * @sl:		sleeper to be started
2044 * @mode:	timer mode abs/rel
2045 *
2046 * Wrapper around hrtimer_start_expires() for hrtimer_sleeper based timers
2047 * to allow PREEMPT_RT to tweak the delivery mode (soft/hardirq context)
2048 */
2049void hrtimer_sleeper_start_expires(struct hrtimer_sleeper *sl,
2050				   enum hrtimer_mode mode)
2051{
2052	/*
2053	 * Make the enqueue delivery mode check work on RT. If the sleeper
2054	 * was initialized for hard interrupt delivery, force the mode bit.
2055	 * This is a special case for hrtimer_sleepers because
2056	 * __hrtimer_init_sleeper() determines the delivery mode on RT so the
2057	 * fiddling with this decision is avoided at the call sites.
2058	 */
2059	if (IS_ENABLED(CONFIG_PREEMPT_RT) && sl->timer.is_hard)
2060		mode |= HRTIMER_MODE_HARD;
2061
2062	hrtimer_start_expires(&sl->timer, mode);
2063}
2064EXPORT_SYMBOL_GPL(hrtimer_sleeper_start_expires);
2065
2066static void __hrtimer_init_sleeper(struct hrtimer_sleeper *sl,
2067				   clockid_t clock_id, enum hrtimer_mode mode)
2068{
2069	/*
2070	 * On PREEMPT_RT enabled kernels hrtimers which are not explicitly
2071	 * marked for hard interrupt expiry mode are moved into soft
2072	 * interrupt context either for latency reasons or because the
2073	 * hrtimer callback takes regular spinlocks or invokes other
2074	 * functions which are not suitable for hard interrupt context on
2075	 * PREEMPT_RT.
2076	 *
2077	 * The hrtimer_sleeper callback is RT compatible in hard interrupt
2078	 * context, but there is a latency concern: Untrusted userspace can
2079	 * spawn many threads which arm timers for the same expiry time on
2080	 * the same CPU. That causes a latency spike due to the wakeup of
2081	 * a gazillion threads.
2082	 *
2083	 * OTOH, privileged real-time user space applications rely on the
2084	 * low latency of hard interrupt wakeups. If the current task is in
2085	 * a real-time scheduling class, mark the mode for hard interrupt
2086	 * expiry.
2087	 */
2088	if (IS_ENABLED(CONFIG_PREEMPT_RT)) {
2089		if (rt_or_dl_task_policy(current) && !(mode & HRTIMER_MODE_SOFT))
2090			mode |= HRTIMER_MODE_HARD;
2091	}
2092
2093	__hrtimer_init(&sl->timer, clock_id, mode);
2094	sl->timer.function = hrtimer_wakeup;
2095	sl->task = current;
2096}
2097
2098/**
2099 * hrtimer_setup_sleeper_on_stack - initialize a sleeper in stack memory
2100 * @sl:		sleeper to be initialized
2101 * @clock_id:	the clock to be used
2102 * @mode:	timer mode abs/rel
2103 */
2104void hrtimer_setup_sleeper_on_stack(struct hrtimer_sleeper *sl,
2105				    clockid_t clock_id, enum hrtimer_mode mode)
2106{
2107	debug_init_on_stack(&sl->timer, clock_id, mode);
2108	__hrtimer_init_sleeper(sl, clock_id, mode);
2109}
2110EXPORT_SYMBOL_GPL(hrtimer_setup_sleeper_on_stack);
2111
2112int nanosleep_copyout(struct restart_block *restart, struct timespec64 *ts)
2113{
2114	switch(restart->nanosleep.type) {
2115#ifdef CONFIG_COMPAT_32BIT_TIME
2116	case TT_COMPAT:
2117		if (put_old_timespec32(ts, restart->nanosleep.compat_rmtp))
2118			return -EFAULT;
2119		break;
2120#endif
2121	case TT_NATIVE:
2122		if (put_timespec64(ts, restart->nanosleep.rmtp))
2123			return -EFAULT;
2124		break;
2125	default:
2126		BUG();
2127	}
2128	return -ERESTART_RESTARTBLOCK;
2129}
2130
2131static int __sched do_nanosleep(struct hrtimer_sleeper *t, enum hrtimer_mode mode)
2132{
2133	struct restart_block *restart;
2134
 
 
2135	do {
2136		set_current_state(TASK_INTERRUPTIBLE|TASK_FREEZABLE);
2137		hrtimer_sleeper_start_expires(t, mode);
2138
2139		if (likely(t->task))
2140			schedule();
2141
2142		hrtimer_cancel(&t->timer);
2143		mode = HRTIMER_MODE_ABS;
2144
2145	} while (t->task && !signal_pending(current));
2146
2147	__set_current_state(TASK_RUNNING);
2148
2149	if (!t->task)
2150		return 0;
2151
2152	restart = &current->restart_block;
2153	if (restart->nanosleep.type != TT_NONE) {
2154		ktime_t rem = hrtimer_expires_remaining(&t->timer);
2155		struct timespec64 rmt;
2156
2157		if (rem <= 0)
2158			return 0;
2159		rmt = ktime_to_timespec64(rem);
2160
2161		return nanosleep_copyout(restart, &rmt);
2162	}
2163	return -ERESTART_RESTARTBLOCK;
2164}
2165
2166static long __sched hrtimer_nanosleep_restart(struct restart_block *restart)
2167{
2168	struct hrtimer_sleeper t;
2169	int ret;
2170
2171	hrtimer_setup_sleeper_on_stack(&t, restart->nanosleep.clockid, HRTIMER_MODE_ABS);
 
2172	hrtimer_set_expires_tv64(&t.timer, restart->nanosleep.expires);
 
2173	ret = do_nanosleep(&t, HRTIMER_MODE_ABS);
2174	destroy_hrtimer_on_stack(&t.timer);
2175	return ret;
2176}
2177
2178long hrtimer_nanosleep(ktime_t rqtp, const enum hrtimer_mode mode,
2179		       const clockid_t clockid)
2180{
2181	struct restart_block *restart;
2182	struct hrtimer_sleeper t;
2183	int ret = 0;
 
2184
2185	hrtimer_setup_sleeper_on_stack(&t, clockid, mode);
2186	hrtimer_set_expires_range_ns(&t.timer, rqtp, current->timer_slack_ns);
 
 
 
 
2187	ret = do_nanosleep(&t, mode);
2188	if (ret != -ERESTART_RESTARTBLOCK)
2189		goto out;
2190
2191	/* Absolute timers do not update the rmtp value and restart: */
2192	if (mode == HRTIMER_MODE_ABS) {
2193		ret = -ERESTARTNOHAND;
2194		goto out;
2195	}
2196
2197	restart = &current->restart_block;
 
2198	restart->nanosleep.clockid = t.timer.base->clockid;
2199	restart->nanosleep.expires = hrtimer_get_expires_tv64(&t.timer);
2200	set_restart_fn(restart, hrtimer_nanosleep_restart);
2201out:
2202	destroy_hrtimer_on_stack(&t.timer);
2203	return ret;
2204}
2205
2206#ifdef CONFIG_64BIT
2207
2208SYSCALL_DEFINE2(nanosleep, struct __kernel_timespec __user *, rqtp,
2209		struct __kernel_timespec __user *, rmtp)
2210{
2211	struct timespec64 tu;
2212
2213	if (get_timespec64(&tu, rqtp))
2214		return -EFAULT;
2215
2216	if (!timespec64_valid(&tu))
2217		return -EINVAL;
2218
2219	current->restart_block.fn = do_no_restart_syscall;
2220	current->restart_block.nanosleep.type = rmtp ? TT_NATIVE : TT_NONE;
2221	current->restart_block.nanosleep.rmtp = rmtp;
2222	return hrtimer_nanosleep(timespec64_to_ktime(tu), HRTIMER_MODE_REL,
2223				 CLOCK_MONOTONIC);
2224}
2225
2226#endif
2227
2228#ifdef CONFIG_COMPAT_32BIT_TIME
2229
2230SYSCALL_DEFINE2(nanosleep_time32, struct old_timespec32 __user *, rqtp,
2231		       struct old_timespec32 __user *, rmtp)
2232{
2233	struct timespec64 tu;
2234
2235	if (get_old_timespec32(&tu, rqtp))
2236		return -EFAULT;
2237
2238	if (!timespec64_valid(&tu))
2239		return -EINVAL;
2240
2241	current->restart_block.fn = do_no_restart_syscall;
2242	current->restart_block.nanosleep.type = rmtp ? TT_COMPAT : TT_NONE;
2243	current->restart_block.nanosleep.compat_rmtp = rmtp;
2244	return hrtimer_nanosleep(timespec64_to_ktime(tu), HRTIMER_MODE_REL,
2245				 CLOCK_MONOTONIC);
2246}
2247#endif
2248
2249/*
2250 * Functions related to boot-time initialization:
2251 */
2252int hrtimers_prepare_cpu(unsigned int cpu)
2253{
2254	struct hrtimer_cpu_base *cpu_base = &per_cpu(hrtimer_bases, cpu);
2255	int i;
2256
2257	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
2258		struct hrtimer_clock_base *clock_b = &cpu_base->clock_base[i];
2259
2260		clock_b->cpu_base = cpu_base;
2261		seqcount_raw_spinlock_init(&clock_b->seq, &cpu_base->lock);
2262		timerqueue_init_head(&clock_b->active);
2263	}
2264
2265	cpu_base->cpu = cpu;
2266	hrtimer_cpu_base_init_expiry_lock(cpu_base);
2267	return 0;
2268}
2269
2270int hrtimers_cpu_starting(unsigned int cpu)
2271{
2272	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
2273
2274	/* Clear out any left over state from a CPU down operation */
2275	cpu_base->active_bases = 0;
2276	cpu_base->hres_active = 0;
2277	cpu_base->hang_detected = 0;
2278	cpu_base->next_timer = NULL;
2279	cpu_base->softirq_next_timer = NULL;
2280	cpu_base->expires_next = KTIME_MAX;
2281	cpu_base->softirq_expires_next = KTIME_MAX;
2282	cpu_base->online = 1;
2283	return 0;
2284}
2285
2286#ifdef CONFIG_HOTPLUG_CPU
2287
2288static void migrate_hrtimer_list(struct hrtimer_clock_base *old_base,
2289				struct hrtimer_clock_base *new_base)
2290{
2291	struct hrtimer *timer;
2292	struct timerqueue_node *node;
2293
2294	while ((node = timerqueue_getnext(&old_base->active))) {
2295		timer = container_of(node, struct hrtimer, node);
2296		BUG_ON(hrtimer_callback_running(timer));
2297		debug_deactivate(timer);
2298
2299		/*
2300		 * Mark it as ENQUEUED not INACTIVE otherwise the
2301		 * timer could be seen as !active and just vanish away
2302		 * under us on another CPU
2303		 */
2304		__remove_hrtimer(timer, old_base, HRTIMER_STATE_ENQUEUED, 0);
2305		timer->base = new_base;
2306		/*
2307		 * Enqueue the timers on the new cpu. This does not
2308		 * reprogram the event device in case the timer
2309		 * expires before the earliest on this CPU, but we run
2310		 * hrtimer_interrupt after we migrated everything to
2311		 * sort out already expired timers and reprogram the
2312		 * event device.
2313		 */
2314		enqueue_hrtimer(timer, new_base, HRTIMER_MODE_ABS);
2315	}
2316}
2317
2318int hrtimers_cpu_dying(unsigned int dying_cpu)
2319{
2320	int i, ncpu = cpumask_any_and(cpu_active_mask, housekeeping_cpumask(HK_TYPE_TIMER));
2321	struct hrtimer_cpu_base *old_base, *new_base;
 
2322
2323	old_base = this_cpu_ptr(&hrtimer_bases);
2324	new_base = &per_cpu(hrtimer_bases, ncpu);
2325
2326	/*
 
 
 
 
 
 
 
 
 
2327	 * The caller is globally serialized and nobody else
2328	 * takes two locks at once, deadlock is not possible.
2329	 */
2330	raw_spin_lock(&old_base->lock);
2331	raw_spin_lock_nested(&new_base->lock, SINGLE_DEPTH_NESTING);
2332
2333	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
2334		migrate_hrtimer_list(&old_base->clock_base[i],
2335				     &new_base->clock_base[i]);
2336	}
2337
2338	/*
2339	 * The migration might have changed the first expiring softirq
2340	 * timer on this CPU. Update it.
2341	 */
2342	__hrtimer_get_next_event(new_base, HRTIMER_ACTIVE_SOFT);
2343	/* Tell the other CPU to retrigger the next event */
2344	smp_call_function_single(ncpu, retrigger_next_event, NULL, 0);
2345
 
2346	raw_spin_unlock(&new_base->lock);
2347	old_base->online = 0;
2348	raw_spin_unlock(&old_base->lock);
2349
 
 
 
 
2350	return 0;
2351}
2352
2353#endif /* CONFIG_HOTPLUG_CPU */
2354
2355void __init hrtimers_init(void)
2356{
2357	hrtimers_prepare_cpu(smp_processor_id());
2358	hrtimers_cpu_starting(smp_processor_id());
2359	open_softirq(HRTIMER_SOFTIRQ, hrtimer_run_softirq);
2360}