xref: /openbmc/linux/kernel/time/hrtimer.c (revision 5de2755c8c8b3a6b8414870e2c284914a2b42e4d)
15cee9645SThomas Gleixner /*
25cee9645SThomas Gleixner  *  linux/kernel/hrtimer.c
35cee9645SThomas Gleixner  *
45cee9645SThomas Gleixner  *  Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
55cee9645SThomas Gleixner  *  Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
65cee9645SThomas Gleixner  *  Copyright(C) 2006-2007  Timesys Corp., Thomas Gleixner
75cee9645SThomas Gleixner  *
85cee9645SThomas Gleixner  *  High-resolution kernel timers
95cee9645SThomas Gleixner  *
105cee9645SThomas Gleixner  *  In contrast to the low-resolution timeout API implemented in
115cee9645SThomas Gleixner  *  kernel/timer.c, hrtimers provide finer resolution and accuracy
125cee9645SThomas Gleixner  *  depending on system configuration and capabilities.
135cee9645SThomas Gleixner  *
145cee9645SThomas Gleixner  *  These timers are currently used for:
155cee9645SThomas Gleixner  *   - itimers
165cee9645SThomas Gleixner  *   - POSIX timers
175cee9645SThomas Gleixner  *   - nanosleep
185cee9645SThomas Gleixner  *   - precise in-kernel timing
195cee9645SThomas Gleixner  *
205cee9645SThomas Gleixner  *  Started by: Thomas Gleixner and Ingo Molnar
215cee9645SThomas Gleixner  *
225cee9645SThomas Gleixner  *  Credits:
235cee9645SThomas Gleixner  *	based on kernel/timer.c
245cee9645SThomas Gleixner  *
255cee9645SThomas Gleixner  *	Help, testing, suggestions, bugfixes, improvements were
265cee9645SThomas Gleixner  *	provided by:
275cee9645SThomas Gleixner  *
285cee9645SThomas Gleixner  *	George Anzinger, Andrew Morton, Steven Rostedt, Roman Zippel
295cee9645SThomas Gleixner  *	et. al.
305cee9645SThomas Gleixner  *
315cee9645SThomas Gleixner  *  For licencing details see kernel-base/COPYING
325cee9645SThomas Gleixner  */
335cee9645SThomas Gleixner 
345cee9645SThomas Gleixner #include <linux/cpu.h>
355cee9645SThomas Gleixner #include <linux/export.h>
365cee9645SThomas Gleixner #include <linux/percpu.h>
375cee9645SThomas Gleixner #include <linux/hrtimer.h>
385cee9645SThomas Gleixner #include <linux/notifier.h>
395cee9645SThomas Gleixner #include <linux/syscalls.h>
405cee9645SThomas Gleixner #include <linux/kallsyms.h>
415cee9645SThomas Gleixner #include <linux/interrupt.h>
425cee9645SThomas Gleixner #include <linux/tick.h>
435cee9645SThomas Gleixner #include <linux/seq_file.h>
445cee9645SThomas Gleixner #include <linux/err.h>
455cee9645SThomas Gleixner #include <linux/debugobjects.h>
465cee9645SThomas Gleixner #include <linux/sched.h>
475cee9645SThomas Gleixner #include <linux/sched/sysctl.h>
485cee9645SThomas Gleixner #include <linux/sched/rt.h>
495cee9645SThomas Gleixner #include <linux/sched/deadline.h>
505cee9645SThomas Gleixner #include <linux/timer.h>
515cee9645SThomas Gleixner #include <linux/freezer.h>
525cee9645SThomas Gleixner 
535cee9645SThomas Gleixner #include <asm/uaccess.h>
545cee9645SThomas Gleixner 
555cee9645SThomas Gleixner #include <trace/events/timer.h>
565cee9645SThomas Gleixner 
57c1797bafSThomas Gleixner #include "tick-internal.h"
588b094cd0SThomas Gleixner 
595cee9645SThomas Gleixner /*
605cee9645SThomas Gleixner  * The timer bases:
615cee9645SThomas Gleixner  *
625cee9645SThomas Gleixner  * There are more clockids then hrtimer bases. Thus, we index
635cee9645SThomas Gleixner  * into the timer bases by the hrtimer_base_type enum. When trying
645cee9645SThomas Gleixner  * to reach a base using a clockid, hrtimer_clockid_to_base()
655cee9645SThomas Gleixner  * is used to convert from clockid to the proper hrtimer_base_type.
665cee9645SThomas Gleixner  */
675cee9645SThomas Gleixner DEFINE_PER_CPU(struct hrtimer_cpu_base, hrtimer_bases) =
685cee9645SThomas Gleixner {
695cee9645SThomas Gleixner 	.lock = __RAW_SPIN_LOCK_UNLOCKED(hrtimer_bases.lock),
705cee9645SThomas Gleixner 	.clock_base =
715cee9645SThomas Gleixner 	{
725cee9645SThomas Gleixner 		{
735cee9645SThomas Gleixner 			.index = HRTIMER_BASE_MONOTONIC,
745cee9645SThomas Gleixner 			.clockid = CLOCK_MONOTONIC,
755cee9645SThomas Gleixner 			.get_time = &ktime_get,
765cee9645SThomas Gleixner 		},
775cee9645SThomas Gleixner 		{
785cee9645SThomas Gleixner 			.index = HRTIMER_BASE_REALTIME,
795cee9645SThomas Gleixner 			.clockid = CLOCK_REALTIME,
805cee9645SThomas Gleixner 			.get_time = &ktime_get_real,
815cee9645SThomas Gleixner 		},
825cee9645SThomas Gleixner 		{
835cee9645SThomas Gleixner 			.index = HRTIMER_BASE_BOOTTIME,
845cee9645SThomas Gleixner 			.clockid = CLOCK_BOOTTIME,
855cee9645SThomas Gleixner 			.get_time = &ktime_get_boottime,
865cee9645SThomas Gleixner 		},
875cee9645SThomas Gleixner 		{
885cee9645SThomas Gleixner 			.index = HRTIMER_BASE_TAI,
895cee9645SThomas Gleixner 			.clockid = CLOCK_TAI,
905cee9645SThomas Gleixner 			.get_time = &ktime_get_clocktai,
915cee9645SThomas Gleixner 		},
925cee9645SThomas Gleixner 	}
935cee9645SThomas Gleixner };
945cee9645SThomas Gleixner 
955cee9645SThomas Gleixner static const int hrtimer_clock_to_base_table[MAX_CLOCKS] = {
965cee9645SThomas Gleixner 	[CLOCK_REALTIME]	= HRTIMER_BASE_REALTIME,
975cee9645SThomas Gleixner 	[CLOCK_MONOTONIC]	= HRTIMER_BASE_MONOTONIC,
985cee9645SThomas Gleixner 	[CLOCK_BOOTTIME]	= HRTIMER_BASE_BOOTTIME,
995cee9645SThomas Gleixner 	[CLOCK_TAI]		= HRTIMER_BASE_TAI,
1005cee9645SThomas Gleixner };
1015cee9645SThomas Gleixner 
1025cee9645SThomas Gleixner static inline int hrtimer_clockid_to_base(clockid_t clock_id)
1035cee9645SThomas Gleixner {
1045cee9645SThomas Gleixner 	return hrtimer_clock_to_base_table[clock_id];
1055cee9645SThomas Gleixner }
1065cee9645SThomas Gleixner 
1075cee9645SThomas Gleixner /*
1085cee9645SThomas Gleixner  * Functions and macros which are different for UP/SMP systems are kept in a
1095cee9645SThomas Gleixner  * single place
1105cee9645SThomas Gleixner  */
1115cee9645SThomas Gleixner #ifdef CONFIG_SMP
1125cee9645SThomas Gleixner 
1135cee9645SThomas Gleixner /*
1145cee9645SThomas Gleixner  * We are using hashed locking: holding per_cpu(hrtimer_bases)[n].lock
1155cee9645SThomas Gleixner  * means that all timers which are tied to this base via timer->base are
1165cee9645SThomas Gleixner  * locked, and the base itself is locked too.
1175cee9645SThomas Gleixner  *
1185cee9645SThomas Gleixner  * So __run_timers/migrate_timers can safely modify all timers which could
1195cee9645SThomas Gleixner  * be found on the lists/queues.
1205cee9645SThomas Gleixner  *
1215cee9645SThomas Gleixner  * When the timer's base is locked, and the timer removed from list, it is
1225cee9645SThomas Gleixner  * possible to set timer->base = NULL and drop the lock: the timer remains
1235cee9645SThomas Gleixner  * locked.
1245cee9645SThomas Gleixner  */
1255cee9645SThomas Gleixner static
1265cee9645SThomas Gleixner struct hrtimer_clock_base *lock_hrtimer_base(const struct hrtimer *timer,
1275cee9645SThomas Gleixner 					     unsigned long *flags)
1285cee9645SThomas Gleixner {
1295cee9645SThomas Gleixner 	struct hrtimer_clock_base *base;
1305cee9645SThomas Gleixner 
1315cee9645SThomas Gleixner 	for (;;) {
1325cee9645SThomas Gleixner 		base = timer->base;
1335cee9645SThomas Gleixner 		if (likely(base != NULL)) {
1345cee9645SThomas Gleixner 			raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
1355cee9645SThomas Gleixner 			if (likely(base == timer->base))
1365cee9645SThomas Gleixner 				return base;
1375cee9645SThomas Gleixner 			/* The timer has migrated to another CPU: */
1385cee9645SThomas Gleixner 			raw_spin_unlock_irqrestore(&base->cpu_base->lock, *flags);
1395cee9645SThomas Gleixner 		}
1405cee9645SThomas Gleixner 		cpu_relax();
1415cee9645SThomas Gleixner 	}
1425cee9645SThomas Gleixner }
1435cee9645SThomas Gleixner 
1445cee9645SThomas Gleixner /*
1455cee9645SThomas Gleixner  * With HIGHRES=y we do not migrate the timer when it is expiring
1465cee9645SThomas Gleixner  * before the next event on the target cpu because we cannot reprogram
1475cee9645SThomas Gleixner  * the target cpu hardware and we would cause it to fire late.
1485cee9645SThomas Gleixner  *
1495cee9645SThomas Gleixner  * Called with cpu_base->lock of target cpu held.
1505cee9645SThomas Gleixner  */
1515cee9645SThomas Gleixner static int
1525cee9645SThomas Gleixner hrtimer_check_target(struct hrtimer *timer, struct hrtimer_clock_base *new_base)
1535cee9645SThomas Gleixner {
1545cee9645SThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
1555cee9645SThomas Gleixner 	ktime_t expires;
1565cee9645SThomas Gleixner 
1575cee9645SThomas Gleixner 	if (!new_base->cpu_base->hres_active)
1585cee9645SThomas Gleixner 		return 0;
1595cee9645SThomas Gleixner 
1605cee9645SThomas Gleixner 	expires = ktime_sub(hrtimer_get_expires(timer), new_base->offset);
1615cee9645SThomas Gleixner 	return expires.tv64 <= new_base->cpu_base->expires_next.tv64;
1625cee9645SThomas Gleixner #else
1635cee9645SThomas Gleixner 	return 0;
1645cee9645SThomas Gleixner #endif
1655cee9645SThomas Gleixner }
1665cee9645SThomas Gleixner 
1675cee9645SThomas Gleixner /*
1685cee9645SThomas Gleixner  * Switch the timer base to the current CPU when possible.
1695cee9645SThomas Gleixner  */
1705cee9645SThomas Gleixner static inline struct hrtimer_clock_base *
1715cee9645SThomas Gleixner switch_hrtimer_base(struct hrtimer *timer, struct hrtimer_clock_base *base,
1725cee9645SThomas Gleixner 		    int pinned)
1735cee9645SThomas Gleixner {
1745cee9645SThomas Gleixner 	struct hrtimer_clock_base *new_base;
1755cee9645SThomas Gleixner 	struct hrtimer_cpu_base *new_cpu_base;
1765cee9645SThomas Gleixner 	int this_cpu = smp_processor_id();
1775cee9645SThomas Gleixner 	int cpu = get_nohz_timer_target(pinned);
1785cee9645SThomas Gleixner 	int basenum = base->index;
1795cee9645SThomas Gleixner 
1805cee9645SThomas Gleixner again:
1815cee9645SThomas Gleixner 	new_cpu_base = &per_cpu(hrtimer_bases, cpu);
1825cee9645SThomas Gleixner 	new_base = &new_cpu_base->clock_base[basenum];
1835cee9645SThomas Gleixner 
1845cee9645SThomas Gleixner 	if (base != new_base) {
1855cee9645SThomas Gleixner 		/*
1865cee9645SThomas Gleixner 		 * We are trying to move timer to new_base.
1875cee9645SThomas Gleixner 		 * However we can't change timer's base while it is running,
1885cee9645SThomas Gleixner 		 * so we keep it on the same CPU. No hassle vs. reprogramming
1895cee9645SThomas Gleixner 		 * the event source in the high resolution case. The softirq
1905cee9645SThomas Gleixner 		 * code will take care of this when the timer function has
1915cee9645SThomas Gleixner 		 * completed. There is no conflict as we hold the lock until
1925cee9645SThomas Gleixner 		 * the timer is enqueued.
1935cee9645SThomas Gleixner 		 */
1945cee9645SThomas Gleixner 		if (unlikely(hrtimer_callback_running(timer)))
1955cee9645SThomas Gleixner 			return base;
1965cee9645SThomas Gleixner 
1975cee9645SThomas Gleixner 		/* See the comment in lock_timer_base() */
1985cee9645SThomas Gleixner 		timer->base = NULL;
1995cee9645SThomas Gleixner 		raw_spin_unlock(&base->cpu_base->lock);
2005cee9645SThomas Gleixner 		raw_spin_lock(&new_base->cpu_base->lock);
2015cee9645SThomas Gleixner 
2025cee9645SThomas Gleixner 		if (cpu != this_cpu && hrtimer_check_target(timer, new_base)) {
2035cee9645SThomas Gleixner 			cpu = this_cpu;
2045cee9645SThomas Gleixner 			raw_spin_unlock(&new_base->cpu_base->lock);
2055cee9645SThomas Gleixner 			raw_spin_lock(&base->cpu_base->lock);
2065cee9645SThomas Gleixner 			timer->base = base;
2075cee9645SThomas Gleixner 			goto again;
2085cee9645SThomas Gleixner 		}
2095cee9645SThomas Gleixner 		timer->base = new_base;
2105cee9645SThomas Gleixner 	} else {
2115cee9645SThomas Gleixner 		if (cpu != this_cpu && hrtimer_check_target(timer, new_base)) {
2125cee9645SThomas Gleixner 			cpu = this_cpu;
2135cee9645SThomas Gleixner 			goto again;
2145cee9645SThomas Gleixner 		}
2155cee9645SThomas Gleixner 	}
2165cee9645SThomas Gleixner 	return new_base;
2175cee9645SThomas Gleixner }
2185cee9645SThomas Gleixner 
2195cee9645SThomas Gleixner #else /* CONFIG_SMP */
2205cee9645SThomas Gleixner 
2215cee9645SThomas Gleixner static inline struct hrtimer_clock_base *
2225cee9645SThomas Gleixner lock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
2235cee9645SThomas Gleixner {
2245cee9645SThomas Gleixner 	struct hrtimer_clock_base *base = timer->base;
2255cee9645SThomas Gleixner 
2265cee9645SThomas Gleixner 	raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
2275cee9645SThomas Gleixner 
2285cee9645SThomas Gleixner 	return base;
2295cee9645SThomas Gleixner }
2305cee9645SThomas Gleixner 
2315cee9645SThomas Gleixner # define switch_hrtimer_base(t, b, p)	(b)
2325cee9645SThomas Gleixner 
2335cee9645SThomas Gleixner #endif	/* !CONFIG_SMP */
2345cee9645SThomas Gleixner 
2355cee9645SThomas Gleixner /*
2365cee9645SThomas Gleixner  * Functions for the union type storage format of ktime_t which are
2375cee9645SThomas Gleixner  * too large for inlining:
2385cee9645SThomas Gleixner  */
2395cee9645SThomas Gleixner #if BITS_PER_LONG < 64
2405cee9645SThomas Gleixner /*
2415cee9645SThomas Gleixner  * Divide a ktime value by a nanosecond value
2425cee9645SThomas Gleixner  */
2438b618628SNicolas Pitre u64 __ktime_divns(const ktime_t kt, s64 div)
2445cee9645SThomas Gleixner {
2455cee9645SThomas Gleixner 	u64 dclc;
2465cee9645SThomas Gleixner 	int sft = 0;
2475cee9645SThomas Gleixner 
2485cee9645SThomas Gleixner 	dclc = ktime_to_ns(kt);
2495cee9645SThomas Gleixner 	/* Make sure the divisor is less than 2^32: */
2505cee9645SThomas Gleixner 	while (div >> 32) {
2515cee9645SThomas Gleixner 		sft++;
2525cee9645SThomas Gleixner 		div >>= 1;
2535cee9645SThomas Gleixner 	}
2545cee9645SThomas Gleixner 	dclc >>= sft;
2555cee9645SThomas Gleixner 	do_div(dclc, (unsigned long) div);
2565cee9645SThomas Gleixner 
2575cee9645SThomas Gleixner 	return dclc;
2585cee9645SThomas Gleixner }
2598b618628SNicolas Pitre EXPORT_SYMBOL_GPL(__ktime_divns);
2605cee9645SThomas Gleixner #endif /* BITS_PER_LONG >= 64 */
2615cee9645SThomas Gleixner 
2625cee9645SThomas Gleixner /*
2635cee9645SThomas Gleixner  * Add two ktime values and do a safety check for overflow:
2645cee9645SThomas Gleixner  */
2655cee9645SThomas Gleixner ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs)
2665cee9645SThomas Gleixner {
2675cee9645SThomas Gleixner 	ktime_t res = ktime_add(lhs, rhs);
2685cee9645SThomas Gleixner 
2695cee9645SThomas Gleixner 	/*
2705cee9645SThomas Gleixner 	 * We use KTIME_SEC_MAX here, the maximum timeout which we can
2715cee9645SThomas Gleixner 	 * return to user space in a timespec:
2725cee9645SThomas Gleixner 	 */
2735cee9645SThomas Gleixner 	if (res.tv64 < 0 || res.tv64 < lhs.tv64 || res.tv64 < rhs.tv64)
2745cee9645SThomas Gleixner 		res = ktime_set(KTIME_SEC_MAX, 0);
2755cee9645SThomas Gleixner 
2765cee9645SThomas Gleixner 	return res;
2775cee9645SThomas Gleixner }
2785cee9645SThomas Gleixner 
2795cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(ktime_add_safe);
2805cee9645SThomas Gleixner 
2815cee9645SThomas Gleixner #ifdef CONFIG_DEBUG_OBJECTS_TIMERS
2825cee9645SThomas Gleixner 
2835cee9645SThomas Gleixner static struct debug_obj_descr hrtimer_debug_descr;
2845cee9645SThomas Gleixner 
2855cee9645SThomas Gleixner static void *hrtimer_debug_hint(void *addr)
2865cee9645SThomas Gleixner {
2875cee9645SThomas Gleixner 	return ((struct hrtimer *) addr)->function;
2885cee9645SThomas Gleixner }
2895cee9645SThomas Gleixner 
2905cee9645SThomas Gleixner /*
2915cee9645SThomas Gleixner  * fixup_init is called when:
2925cee9645SThomas Gleixner  * - an active object is initialized
2935cee9645SThomas Gleixner  */
2945cee9645SThomas Gleixner static int hrtimer_fixup_init(void *addr, enum debug_obj_state state)
2955cee9645SThomas Gleixner {
2965cee9645SThomas Gleixner 	struct hrtimer *timer = addr;
2975cee9645SThomas Gleixner 
2985cee9645SThomas Gleixner 	switch (state) {
2995cee9645SThomas Gleixner 	case ODEBUG_STATE_ACTIVE:
3005cee9645SThomas Gleixner 		hrtimer_cancel(timer);
3015cee9645SThomas Gleixner 		debug_object_init(timer, &hrtimer_debug_descr);
3025cee9645SThomas Gleixner 		return 1;
3035cee9645SThomas Gleixner 	default:
3045cee9645SThomas Gleixner 		return 0;
3055cee9645SThomas Gleixner 	}
3065cee9645SThomas Gleixner }
3075cee9645SThomas Gleixner 
3085cee9645SThomas Gleixner /*
3095cee9645SThomas Gleixner  * fixup_activate is called when:
3105cee9645SThomas Gleixner  * - an active object is activated
3115cee9645SThomas Gleixner  * - an unknown object is activated (might be a statically initialized object)
3125cee9645SThomas Gleixner  */
3135cee9645SThomas Gleixner static int hrtimer_fixup_activate(void *addr, enum debug_obj_state state)
3145cee9645SThomas Gleixner {
3155cee9645SThomas Gleixner 	switch (state) {
3165cee9645SThomas Gleixner 
3175cee9645SThomas Gleixner 	case ODEBUG_STATE_NOTAVAILABLE:
3185cee9645SThomas Gleixner 		WARN_ON_ONCE(1);
3195cee9645SThomas Gleixner 		return 0;
3205cee9645SThomas Gleixner 
3215cee9645SThomas Gleixner 	case ODEBUG_STATE_ACTIVE:
3225cee9645SThomas Gleixner 		WARN_ON(1);
3235cee9645SThomas Gleixner 
3245cee9645SThomas Gleixner 	default:
3255cee9645SThomas Gleixner 		return 0;
3265cee9645SThomas Gleixner 	}
3275cee9645SThomas Gleixner }
3285cee9645SThomas Gleixner 
3295cee9645SThomas Gleixner /*
3305cee9645SThomas Gleixner  * fixup_free is called when:
3315cee9645SThomas Gleixner  * - an active object is freed
3325cee9645SThomas Gleixner  */
3335cee9645SThomas Gleixner static int hrtimer_fixup_free(void *addr, enum debug_obj_state state)
3345cee9645SThomas Gleixner {
3355cee9645SThomas Gleixner 	struct hrtimer *timer = addr;
3365cee9645SThomas Gleixner 
3375cee9645SThomas Gleixner 	switch (state) {
3385cee9645SThomas Gleixner 	case ODEBUG_STATE_ACTIVE:
3395cee9645SThomas Gleixner 		hrtimer_cancel(timer);
3405cee9645SThomas Gleixner 		debug_object_free(timer, &hrtimer_debug_descr);
3415cee9645SThomas Gleixner 		return 1;
3425cee9645SThomas Gleixner 	default:
3435cee9645SThomas Gleixner 		return 0;
3445cee9645SThomas Gleixner 	}
3455cee9645SThomas Gleixner }
3465cee9645SThomas Gleixner 
3475cee9645SThomas Gleixner static struct debug_obj_descr hrtimer_debug_descr = {
3485cee9645SThomas Gleixner 	.name		= "hrtimer",
3495cee9645SThomas Gleixner 	.debug_hint	= hrtimer_debug_hint,
3505cee9645SThomas Gleixner 	.fixup_init	= hrtimer_fixup_init,
3515cee9645SThomas Gleixner 	.fixup_activate	= hrtimer_fixup_activate,
3525cee9645SThomas Gleixner 	.fixup_free	= hrtimer_fixup_free,
3535cee9645SThomas Gleixner };
3545cee9645SThomas Gleixner 
3555cee9645SThomas Gleixner static inline void debug_hrtimer_init(struct hrtimer *timer)
3565cee9645SThomas Gleixner {
3575cee9645SThomas Gleixner 	debug_object_init(timer, &hrtimer_debug_descr);
3585cee9645SThomas Gleixner }
3595cee9645SThomas Gleixner 
3605cee9645SThomas Gleixner static inline void debug_hrtimer_activate(struct hrtimer *timer)
3615cee9645SThomas Gleixner {
3625cee9645SThomas Gleixner 	debug_object_activate(timer, &hrtimer_debug_descr);
3635cee9645SThomas Gleixner }
3645cee9645SThomas Gleixner 
3655cee9645SThomas Gleixner static inline void debug_hrtimer_deactivate(struct hrtimer *timer)
3665cee9645SThomas Gleixner {
3675cee9645SThomas Gleixner 	debug_object_deactivate(timer, &hrtimer_debug_descr);
3685cee9645SThomas Gleixner }
3695cee9645SThomas Gleixner 
3705cee9645SThomas Gleixner static inline void debug_hrtimer_free(struct hrtimer *timer)
3715cee9645SThomas Gleixner {
3725cee9645SThomas Gleixner 	debug_object_free(timer, &hrtimer_debug_descr);
3735cee9645SThomas Gleixner }
3745cee9645SThomas Gleixner 
3755cee9645SThomas Gleixner static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
3765cee9645SThomas Gleixner 			   enum hrtimer_mode mode);
3775cee9645SThomas Gleixner 
3785cee9645SThomas Gleixner void hrtimer_init_on_stack(struct hrtimer *timer, clockid_t clock_id,
3795cee9645SThomas Gleixner 			   enum hrtimer_mode mode)
3805cee9645SThomas Gleixner {
3815cee9645SThomas Gleixner 	debug_object_init_on_stack(timer, &hrtimer_debug_descr);
3825cee9645SThomas Gleixner 	__hrtimer_init(timer, clock_id, mode);
3835cee9645SThomas Gleixner }
3845cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_init_on_stack);
3855cee9645SThomas Gleixner 
3865cee9645SThomas Gleixner void destroy_hrtimer_on_stack(struct hrtimer *timer)
3875cee9645SThomas Gleixner {
3885cee9645SThomas Gleixner 	debug_object_free(timer, &hrtimer_debug_descr);
3895cee9645SThomas Gleixner }
3905cee9645SThomas Gleixner 
3915cee9645SThomas Gleixner #else
3925cee9645SThomas Gleixner static inline void debug_hrtimer_init(struct hrtimer *timer) { }
3935cee9645SThomas Gleixner static inline void debug_hrtimer_activate(struct hrtimer *timer) { }
3945cee9645SThomas Gleixner static inline void debug_hrtimer_deactivate(struct hrtimer *timer) { }
3955cee9645SThomas Gleixner #endif
3965cee9645SThomas Gleixner 
3975cee9645SThomas Gleixner static inline void
3985cee9645SThomas Gleixner debug_init(struct hrtimer *timer, clockid_t clockid,
3995cee9645SThomas Gleixner 	   enum hrtimer_mode mode)
4005cee9645SThomas Gleixner {
4015cee9645SThomas Gleixner 	debug_hrtimer_init(timer);
4025cee9645SThomas Gleixner 	trace_hrtimer_init(timer, clockid, mode);
4035cee9645SThomas Gleixner }
4045cee9645SThomas Gleixner 
4055cee9645SThomas Gleixner static inline void debug_activate(struct hrtimer *timer)
4065cee9645SThomas Gleixner {
4075cee9645SThomas Gleixner 	debug_hrtimer_activate(timer);
4085cee9645SThomas Gleixner 	trace_hrtimer_start(timer);
4095cee9645SThomas Gleixner }
4105cee9645SThomas Gleixner 
4115cee9645SThomas Gleixner static inline void debug_deactivate(struct hrtimer *timer)
4125cee9645SThomas Gleixner {
4135cee9645SThomas Gleixner 	debug_hrtimer_deactivate(timer);
4145cee9645SThomas Gleixner 	trace_hrtimer_cancel(timer);
4155cee9645SThomas Gleixner }
4165cee9645SThomas Gleixner 
4179bc74919SThomas Gleixner #if defined(CONFIG_NO_HZ_COMMON) || defined(CONFIG_HIGH_RES_TIMERS)
418895bdfa7SThomas Gleixner static inline void hrtimer_update_next_timer(struct hrtimer_cpu_base *cpu_base,
419895bdfa7SThomas Gleixner 					     struct hrtimer *timer)
420895bdfa7SThomas Gleixner {
421895bdfa7SThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
422895bdfa7SThomas Gleixner 	cpu_base->next_timer = timer;
423895bdfa7SThomas Gleixner #endif
424895bdfa7SThomas Gleixner }
425895bdfa7SThomas Gleixner 
4264ebbda52Skbuild test robot static ktime_t __hrtimer_get_next_event(struct hrtimer_cpu_base *cpu_base)
4279bc74919SThomas Gleixner {
4289bc74919SThomas Gleixner 	struct hrtimer_clock_base *base = cpu_base->clock_base;
4299bc74919SThomas Gleixner 	ktime_t expires, expires_next = { .tv64 = KTIME_MAX };
43034aee88aSThomas Gleixner 	unsigned int active = cpu_base->active_bases;
4319bc74919SThomas Gleixner 
432895bdfa7SThomas Gleixner 	hrtimer_update_next_timer(cpu_base, NULL);
43334aee88aSThomas Gleixner 	for (; active; base++, active >>= 1) {
4349bc74919SThomas Gleixner 		struct timerqueue_node *next;
4359bc74919SThomas Gleixner 		struct hrtimer *timer;
4369bc74919SThomas Gleixner 
43734aee88aSThomas Gleixner 		if (!(active & 0x01))
4389bc74919SThomas Gleixner 			continue;
4399bc74919SThomas Gleixner 
44034aee88aSThomas Gleixner 		next = timerqueue_getnext(&base->active);
4419bc74919SThomas Gleixner 		timer = container_of(next, struct hrtimer, node);
4429bc74919SThomas Gleixner 		expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
443895bdfa7SThomas Gleixner 		if (expires.tv64 < expires_next.tv64) {
4449bc74919SThomas Gleixner 			expires_next = expires;
445895bdfa7SThomas Gleixner 			hrtimer_update_next_timer(cpu_base, timer);
446895bdfa7SThomas Gleixner 		}
4479bc74919SThomas Gleixner 	}
4489bc74919SThomas Gleixner 	/*
4499bc74919SThomas Gleixner 	 * clock_was_set() might have changed base->offset of any of
4509bc74919SThomas Gleixner 	 * the clock bases so the result might be negative. Fix it up
4519bc74919SThomas Gleixner 	 * to prevent a false positive in clockevents_program_event().
4529bc74919SThomas Gleixner 	 */
4539bc74919SThomas Gleixner 	if (expires_next.tv64 < 0)
4549bc74919SThomas Gleixner 		expires_next.tv64 = 0;
4559bc74919SThomas Gleixner 	return expires_next;
4569bc74919SThomas Gleixner }
4579bc74919SThomas Gleixner #endif
4589bc74919SThomas Gleixner 
45921d6d52aSThomas Gleixner static inline ktime_t hrtimer_update_base(struct hrtimer_cpu_base *base)
46021d6d52aSThomas Gleixner {
46121d6d52aSThomas Gleixner 	ktime_t *offs_real = &base->clock_base[HRTIMER_BASE_REALTIME].offset;
46221d6d52aSThomas Gleixner 	ktime_t *offs_boot = &base->clock_base[HRTIMER_BASE_BOOTTIME].offset;
46321d6d52aSThomas Gleixner 	ktime_t *offs_tai = &base->clock_base[HRTIMER_BASE_TAI].offset;
46421d6d52aSThomas Gleixner 
465868a3e91SThomas Gleixner 	return ktime_get_update_offsets_now(&base->clock_was_set_seq,
466868a3e91SThomas Gleixner 					    offs_real, offs_boot, offs_tai);
46721d6d52aSThomas Gleixner }
46821d6d52aSThomas Gleixner 
4695cee9645SThomas Gleixner /* High resolution timer related functions */
4705cee9645SThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
4715cee9645SThomas Gleixner 
4725cee9645SThomas Gleixner /*
4735cee9645SThomas Gleixner  * High resolution timer enabled ?
4745cee9645SThomas Gleixner  */
4755cee9645SThomas Gleixner static int hrtimer_hres_enabled __read_mostly  = 1;
476398ca17fSThomas Gleixner unsigned int hrtimer_resolution __read_mostly = LOW_RES_NSEC;
477398ca17fSThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_resolution);
4785cee9645SThomas Gleixner 
4795cee9645SThomas Gleixner /*
4805cee9645SThomas Gleixner  * Enable / Disable high resolution mode
4815cee9645SThomas Gleixner  */
4825cee9645SThomas Gleixner static int __init setup_hrtimer_hres(char *str)
4835cee9645SThomas Gleixner {
4845cee9645SThomas Gleixner 	if (!strcmp(str, "off"))
4855cee9645SThomas Gleixner 		hrtimer_hres_enabled = 0;
4865cee9645SThomas Gleixner 	else if (!strcmp(str, "on"))
4875cee9645SThomas Gleixner 		hrtimer_hres_enabled = 1;
4885cee9645SThomas Gleixner 	else
4895cee9645SThomas Gleixner 		return 0;
4905cee9645SThomas Gleixner 	return 1;
4915cee9645SThomas Gleixner }
4925cee9645SThomas Gleixner 
4935cee9645SThomas Gleixner __setup("highres=", setup_hrtimer_hres);
4945cee9645SThomas Gleixner 
4955cee9645SThomas Gleixner /*
4965cee9645SThomas Gleixner  * hrtimer_high_res_enabled - query, if the highres mode is enabled
4975cee9645SThomas Gleixner  */
4985cee9645SThomas Gleixner static inline int hrtimer_is_hres_enabled(void)
4995cee9645SThomas Gleixner {
5005cee9645SThomas Gleixner 	return hrtimer_hres_enabled;
5015cee9645SThomas Gleixner }
5025cee9645SThomas Gleixner 
5035cee9645SThomas Gleixner /*
5045cee9645SThomas Gleixner  * Is the high resolution mode active ?
5055cee9645SThomas Gleixner  */
506e19ffe8bSThomas Gleixner static inline int __hrtimer_hres_active(struct hrtimer_cpu_base *cpu_base)
507e19ffe8bSThomas Gleixner {
508e19ffe8bSThomas Gleixner 	return cpu_base->hres_active;
509e19ffe8bSThomas Gleixner }
510e19ffe8bSThomas Gleixner 
5115cee9645SThomas Gleixner static inline int hrtimer_hres_active(void)
5125cee9645SThomas Gleixner {
513e19ffe8bSThomas Gleixner 	return __hrtimer_hres_active(this_cpu_ptr(&hrtimer_bases));
5145cee9645SThomas Gleixner }
5155cee9645SThomas Gleixner 
5165cee9645SThomas Gleixner /*
5175cee9645SThomas Gleixner  * Reprogram the event source with checking both queues for the
5185cee9645SThomas Gleixner  * next event
5195cee9645SThomas Gleixner  * Called with interrupts disabled and base->lock held
5205cee9645SThomas Gleixner  */
5215cee9645SThomas Gleixner static void
5225cee9645SThomas Gleixner hrtimer_force_reprogram(struct hrtimer_cpu_base *cpu_base, int skip_equal)
5235cee9645SThomas Gleixner {
52421d6d52aSThomas Gleixner 	ktime_t expires_next;
52521d6d52aSThomas Gleixner 
52621d6d52aSThomas Gleixner 	if (!cpu_base->hres_active)
52721d6d52aSThomas Gleixner 		return;
52821d6d52aSThomas Gleixner 
52921d6d52aSThomas Gleixner 	expires_next = __hrtimer_get_next_event(cpu_base);
5305cee9645SThomas Gleixner 
5315cee9645SThomas Gleixner 	if (skip_equal && expires_next.tv64 == cpu_base->expires_next.tv64)
5325cee9645SThomas Gleixner 		return;
5335cee9645SThomas Gleixner 
5345cee9645SThomas Gleixner 	cpu_base->expires_next.tv64 = expires_next.tv64;
5355cee9645SThomas Gleixner 
5365cee9645SThomas Gleixner 	/*
5375cee9645SThomas Gleixner 	 * If a hang was detected in the last timer interrupt then we
5385cee9645SThomas Gleixner 	 * leave the hang delay active in the hardware. We want the
5395cee9645SThomas Gleixner 	 * system to make progress. That also prevents the following
5405cee9645SThomas Gleixner 	 * scenario:
5415cee9645SThomas Gleixner 	 * T1 expires 50ms from now
5425cee9645SThomas Gleixner 	 * T2 expires 5s from now
5435cee9645SThomas Gleixner 	 *
5445cee9645SThomas Gleixner 	 * T1 is removed, so this code is called and would reprogram
5455cee9645SThomas Gleixner 	 * the hardware to 5s from now. Any hrtimer_start after that
5465cee9645SThomas Gleixner 	 * will not reprogram the hardware due to hang_detected being
5475cee9645SThomas Gleixner 	 * set. So we'd effectivly block all timers until the T2 event
5485cee9645SThomas Gleixner 	 * fires.
5495cee9645SThomas Gleixner 	 */
5505cee9645SThomas Gleixner 	if (cpu_base->hang_detected)
5515cee9645SThomas Gleixner 		return;
5525cee9645SThomas Gleixner 
5535cee9645SThomas Gleixner 	if (cpu_base->expires_next.tv64 != KTIME_MAX)
5545cee9645SThomas Gleixner 		tick_program_event(cpu_base->expires_next, 1);
5555cee9645SThomas Gleixner }
5565cee9645SThomas Gleixner 
5575cee9645SThomas Gleixner /*
5585cee9645SThomas Gleixner  * When a timer is enqueued and expires earlier than the already enqueued
5595cee9645SThomas Gleixner  * timers, we have to check, whether it expires earlier than the timer for
5605cee9645SThomas Gleixner  * which the clock event device was armed.
5615cee9645SThomas Gleixner  *
5625cee9645SThomas Gleixner  * Called with interrupts disabled and base->cpu_base.lock held
5635cee9645SThomas Gleixner  */
564c6eb3f70SThomas Gleixner static void hrtimer_reprogram(struct hrtimer *timer,
5655cee9645SThomas Gleixner 			      struct hrtimer_clock_base *base)
5665cee9645SThomas Gleixner {
567dc5df73bSChristoph Lameter 	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
5685cee9645SThomas Gleixner 	ktime_t expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
5695cee9645SThomas Gleixner 
5705cee9645SThomas Gleixner 	WARN_ON_ONCE(hrtimer_get_expires_tv64(timer) < 0);
5715cee9645SThomas Gleixner 
5725cee9645SThomas Gleixner 	/*
573c6eb3f70SThomas Gleixner 	 * If the timer is not on the current cpu, we cannot reprogram
574c6eb3f70SThomas Gleixner 	 * the other cpus clock event device.
5755cee9645SThomas Gleixner 	 */
576c6eb3f70SThomas Gleixner 	if (base->cpu_base != cpu_base)
577c6eb3f70SThomas Gleixner 		return;
578c6eb3f70SThomas Gleixner 
579c6eb3f70SThomas Gleixner 	/*
580c6eb3f70SThomas Gleixner 	 * If the hrtimer interrupt is running, then it will
581c6eb3f70SThomas Gleixner 	 * reevaluate the clock bases and reprogram the clock event
582c6eb3f70SThomas Gleixner 	 * device. The callbacks are always executed in hard interrupt
583c6eb3f70SThomas Gleixner 	 * context so we don't need an extra check for a running
584c6eb3f70SThomas Gleixner 	 * callback.
585c6eb3f70SThomas Gleixner 	 */
586c6eb3f70SThomas Gleixner 	if (cpu_base->in_hrtirq)
587c6eb3f70SThomas Gleixner 		return;
5885cee9645SThomas Gleixner 
5895cee9645SThomas Gleixner 	/*
5905cee9645SThomas Gleixner 	 * CLOCK_REALTIME timer might be requested with an absolute
591c6eb3f70SThomas Gleixner 	 * expiry time which is less than base->offset. Set it to 0.
5925cee9645SThomas Gleixner 	 */
5935cee9645SThomas Gleixner 	if (expires.tv64 < 0)
594c6eb3f70SThomas Gleixner 		expires.tv64 = 0;
5955cee9645SThomas Gleixner 
5965cee9645SThomas Gleixner 	if (expires.tv64 >= cpu_base->expires_next.tv64)
597c6eb3f70SThomas Gleixner 		return;
5985cee9645SThomas Gleixner 
599c6eb3f70SThomas Gleixner 	/* Update the pointer to the next expiring timer */
600895bdfa7SThomas Gleixner 	cpu_base->next_timer = timer;
601895bdfa7SThomas Gleixner 
6029bc74919SThomas Gleixner 	/*
6035cee9645SThomas Gleixner 	 * If a hang was detected in the last timer interrupt then we
6045cee9645SThomas Gleixner 	 * do not schedule a timer which is earlier than the expiry
6055cee9645SThomas Gleixner 	 * which we enforced in the hang detection. We want the system
6065cee9645SThomas Gleixner 	 * to make progress.
6075cee9645SThomas Gleixner 	 */
6085cee9645SThomas Gleixner 	if (cpu_base->hang_detected)
609c6eb3f70SThomas Gleixner 		return;
6105cee9645SThomas Gleixner 
6115cee9645SThomas Gleixner 	/*
612c6eb3f70SThomas Gleixner 	 * Program the timer hardware. We enforce the expiry for
613c6eb3f70SThomas Gleixner 	 * events which are already in the past.
6145cee9645SThomas Gleixner 	 */
6155cee9645SThomas Gleixner 	cpu_base->expires_next = expires;
616c6eb3f70SThomas Gleixner 	tick_program_event(expires, 1);
6175cee9645SThomas Gleixner }
6185cee9645SThomas Gleixner 
6195cee9645SThomas Gleixner /*
6205cee9645SThomas Gleixner  * Initialize the high resolution related parts of cpu_base
6215cee9645SThomas Gleixner  */
6225cee9645SThomas Gleixner static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base)
6235cee9645SThomas Gleixner {
6245cee9645SThomas Gleixner 	base->expires_next.tv64 = KTIME_MAX;
6255cee9645SThomas Gleixner 	base->hres_active = 0;
6265cee9645SThomas Gleixner }
6275cee9645SThomas Gleixner 
6285cee9645SThomas Gleixner /*
6295cee9645SThomas Gleixner  * Retrigger next event is called after clock was set
6305cee9645SThomas Gleixner  *
6315cee9645SThomas Gleixner  * Called with interrupts disabled via on_each_cpu()
6325cee9645SThomas Gleixner  */
6335cee9645SThomas Gleixner static void retrigger_next_event(void *arg)
6345cee9645SThomas Gleixner {
635dc5df73bSChristoph Lameter 	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
6365cee9645SThomas Gleixner 
637e19ffe8bSThomas Gleixner 	if (!base->hres_active)
6385cee9645SThomas Gleixner 		return;
6395cee9645SThomas Gleixner 
6405cee9645SThomas Gleixner 	raw_spin_lock(&base->lock);
6415cee9645SThomas Gleixner 	hrtimer_update_base(base);
6425cee9645SThomas Gleixner 	hrtimer_force_reprogram(base, 0);
6435cee9645SThomas Gleixner 	raw_spin_unlock(&base->lock);
6445cee9645SThomas Gleixner }
6455cee9645SThomas Gleixner 
6465cee9645SThomas Gleixner /*
6475cee9645SThomas Gleixner  * Switch to high resolution mode
6485cee9645SThomas Gleixner  */
6495cee9645SThomas Gleixner static int hrtimer_switch_to_hres(void)
6505cee9645SThomas Gleixner {
651c6eb3f70SThomas Gleixner 	struct hrtimer_cpu_base *base = this_cpu_ptr(&hrtimer_bases);
6525cee9645SThomas Gleixner 
6535cee9645SThomas Gleixner 	if (tick_init_highres()) {
6545cee9645SThomas Gleixner 		printk(KERN_WARNING "Could not switch to high resolution "
655c6eb3f70SThomas Gleixner 				    "mode on CPU %d\n", base->cpu);
6565cee9645SThomas Gleixner 		return 0;
6575cee9645SThomas Gleixner 	}
6585cee9645SThomas Gleixner 	base->hres_active = 1;
659398ca17fSThomas Gleixner 	hrtimer_resolution = HIGH_RES_NSEC;
6605cee9645SThomas Gleixner 
6615cee9645SThomas Gleixner 	tick_setup_sched_timer();
6625cee9645SThomas Gleixner 	/* "Retrigger" the interrupt to get things going */
6635cee9645SThomas Gleixner 	retrigger_next_event(NULL);
6645cee9645SThomas Gleixner 	return 1;
6655cee9645SThomas Gleixner }
6665cee9645SThomas Gleixner 
6675cee9645SThomas Gleixner static void clock_was_set_work(struct work_struct *work)
6685cee9645SThomas Gleixner {
6695cee9645SThomas Gleixner 	clock_was_set();
6705cee9645SThomas Gleixner }
6715cee9645SThomas Gleixner 
6725cee9645SThomas Gleixner static DECLARE_WORK(hrtimer_work, clock_was_set_work);
6735cee9645SThomas Gleixner 
6745cee9645SThomas Gleixner /*
6755cee9645SThomas Gleixner  * Called from timekeeping and resume code to reprogramm the hrtimer
6765cee9645SThomas Gleixner  * interrupt device on all cpus.
6775cee9645SThomas Gleixner  */
6785cee9645SThomas Gleixner void clock_was_set_delayed(void)
6795cee9645SThomas Gleixner {
6805cee9645SThomas Gleixner 	schedule_work(&hrtimer_work);
6815cee9645SThomas Gleixner }
6825cee9645SThomas Gleixner 
6835cee9645SThomas Gleixner #else
6845cee9645SThomas Gleixner 
685e19ffe8bSThomas Gleixner static inline int __hrtimer_hres_active(struct hrtimer_cpu_base *b) { return 0; }
6865cee9645SThomas Gleixner static inline int hrtimer_hres_active(void) { return 0; }
6875cee9645SThomas Gleixner static inline int hrtimer_is_hres_enabled(void) { return 0; }
6885cee9645SThomas Gleixner static inline int hrtimer_switch_to_hres(void) { return 0; }
6895cee9645SThomas Gleixner static inline void
6905cee9645SThomas Gleixner hrtimer_force_reprogram(struct hrtimer_cpu_base *base, int skip_equal) { }
6919e1e01ddSViresh Kumar static inline int hrtimer_reprogram(struct hrtimer *timer,
6925cee9645SThomas Gleixner 				    struct hrtimer_clock_base *base)
6935cee9645SThomas Gleixner {
6945cee9645SThomas Gleixner 	return 0;
6955cee9645SThomas Gleixner }
6965cee9645SThomas Gleixner static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base) { }
6975cee9645SThomas Gleixner static inline void retrigger_next_event(void *arg) { }
6985cee9645SThomas Gleixner 
6995cee9645SThomas Gleixner #endif /* CONFIG_HIGH_RES_TIMERS */
7005cee9645SThomas Gleixner 
7015cee9645SThomas Gleixner /*
7025cee9645SThomas Gleixner  * Clock realtime was set
7035cee9645SThomas Gleixner  *
7045cee9645SThomas Gleixner  * Change the offset of the realtime clock vs. the monotonic
7055cee9645SThomas Gleixner  * clock.
7065cee9645SThomas Gleixner  *
7075cee9645SThomas Gleixner  * We might have to reprogram the high resolution timer interrupt. On
7085cee9645SThomas Gleixner  * SMP we call the architecture specific code to retrigger _all_ high
7095cee9645SThomas Gleixner  * resolution timer interrupts. On UP we just disable interrupts and
7105cee9645SThomas Gleixner  * call the high resolution interrupt code.
7115cee9645SThomas Gleixner  */
7125cee9645SThomas Gleixner void clock_was_set(void)
7135cee9645SThomas Gleixner {
7145cee9645SThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
7155cee9645SThomas Gleixner 	/* Retrigger the CPU local events everywhere */
7165cee9645SThomas Gleixner 	on_each_cpu(retrigger_next_event, NULL, 1);
7175cee9645SThomas Gleixner #endif
7185cee9645SThomas Gleixner 	timerfd_clock_was_set();
7195cee9645SThomas Gleixner }
7205cee9645SThomas Gleixner 
7215cee9645SThomas Gleixner /*
7225cee9645SThomas Gleixner  * During resume we might have to reprogram the high resolution timer
7235cee9645SThomas Gleixner  * interrupt on all online CPUs.  However, all other CPUs will be
7245cee9645SThomas Gleixner  * stopped with IRQs interrupts disabled so the clock_was_set() call
7255cee9645SThomas Gleixner  * must be deferred.
7265cee9645SThomas Gleixner  */
7275cee9645SThomas Gleixner void hrtimers_resume(void)
7285cee9645SThomas Gleixner {
7295cee9645SThomas Gleixner 	WARN_ONCE(!irqs_disabled(),
7305cee9645SThomas Gleixner 		  KERN_INFO "hrtimers_resume() called with IRQs enabled!");
7315cee9645SThomas Gleixner 
7325cee9645SThomas Gleixner 	/* Retrigger on the local CPU */
7335cee9645SThomas Gleixner 	retrigger_next_event(NULL);
7345cee9645SThomas Gleixner 	/* And schedule a retrigger for all others */
7355cee9645SThomas Gleixner 	clock_was_set_delayed();
7365cee9645SThomas Gleixner }
7375cee9645SThomas Gleixner 
7385cee9645SThomas Gleixner static inline void timer_stats_hrtimer_set_start_info(struct hrtimer *timer)
7395cee9645SThomas Gleixner {
7405cee9645SThomas Gleixner #ifdef CONFIG_TIMER_STATS
7415cee9645SThomas Gleixner 	if (timer->start_site)
7425cee9645SThomas Gleixner 		return;
7435cee9645SThomas Gleixner 	timer->start_site = __builtin_return_address(0);
7445cee9645SThomas Gleixner 	memcpy(timer->start_comm, current->comm, TASK_COMM_LEN);
7455cee9645SThomas Gleixner 	timer->start_pid = current->pid;
7465cee9645SThomas Gleixner #endif
7475cee9645SThomas Gleixner }
7485cee9645SThomas Gleixner 
7495cee9645SThomas Gleixner static inline void timer_stats_hrtimer_clear_start_info(struct hrtimer *timer)
7505cee9645SThomas Gleixner {
7515cee9645SThomas Gleixner #ifdef CONFIG_TIMER_STATS
7525cee9645SThomas Gleixner 	timer->start_site = NULL;
7535cee9645SThomas Gleixner #endif
7545cee9645SThomas Gleixner }
7555cee9645SThomas Gleixner 
7565cee9645SThomas Gleixner static inline void timer_stats_account_hrtimer(struct hrtimer *timer)
7575cee9645SThomas Gleixner {
7585cee9645SThomas Gleixner #ifdef CONFIG_TIMER_STATS
7595cee9645SThomas Gleixner 	if (likely(!timer_stats_active))
7605cee9645SThomas Gleixner 		return;
7615cee9645SThomas Gleixner 	timer_stats_update_stats(timer, timer->start_pid, timer->start_site,
7625cee9645SThomas Gleixner 				 timer->function, timer->start_comm, 0);
7635cee9645SThomas Gleixner #endif
7645cee9645SThomas Gleixner }
7655cee9645SThomas Gleixner 
7665cee9645SThomas Gleixner /*
7675cee9645SThomas Gleixner  * Counterpart to lock_hrtimer_base above:
7685cee9645SThomas Gleixner  */
7695cee9645SThomas Gleixner static inline
7705cee9645SThomas Gleixner void unlock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
7715cee9645SThomas Gleixner {
7725cee9645SThomas Gleixner 	raw_spin_unlock_irqrestore(&timer->base->cpu_base->lock, *flags);
7735cee9645SThomas Gleixner }
7745cee9645SThomas Gleixner 
7755cee9645SThomas Gleixner /**
7765cee9645SThomas Gleixner  * hrtimer_forward - forward the timer expiry
7775cee9645SThomas Gleixner  * @timer:	hrtimer to forward
7785cee9645SThomas Gleixner  * @now:	forward past this time
7795cee9645SThomas Gleixner  * @interval:	the interval to forward
7805cee9645SThomas Gleixner  *
7815cee9645SThomas Gleixner  * Forward the timer expiry so it will expire in the future.
7825cee9645SThomas Gleixner  * Returns the number of overruns.
78391e5a217SThomas Gleixner  *
78491e5a217SThomas Gleixner  * Can be safely called from the callback function of @timer. If
78591e5a217SThomas Gleixner  * called from other contexts @timer must neither be enqueued nor
78691e5a217SThomas Gleixner  * running the callback and the caller needs to take care of
78791e5a217SThomas Gleixner  * serialization.
78891e5a217SThomas Gleixner  *
78991e5a217SThomas Gleixner  * Note: This only updates the timer expiry value and does not requeue
79091e5a217SThomas Gleixner  * the timer.
7915cee9645SThomas Gleixner  */
7925cee9645SThomas Gleixner u64 hrtimer_forward(struct hrtimer *timer, ktime_t now, ktime_t interval)
7935cee9645SThomas Gleixner {
7945cee9645SThomas Gleixner 	u64 orun = 1;
7955cee9645SThomas Gleixner 	ktime_t delta;
7965cee9645SThomas Gleixner 
7975cee9645SThomas Gleixner 	delta = ktime_sub(now, hrtimer_get_expires(timer));
7985cee9645SThomas Gleixner 
7995cee9645SThomas Gleixner 	if (delta.tv64 < 0)
8005cee9645SThomas Gleixner 		return 0;
8015cee9645SThomas Gleixner 
802*5de2755cSPeter Zijlstra 	if (WARN_ON(timer->state & HRTIMER_STATE_ENQUEUED))
803*5de2755cSPeter Zijlstra 		return 0;
804*5de2755cSPeter Zijlstra 
805398ca17fSThomas Gleixner 	if (interval.tv64 < hrtimer_resolution)
806398ca17fSThomas Gleixner 		interval.tv64 = hrtimer_resolution;
8075cee9645SThomas Gleixner 
8085cee9645SThomas Gleixner 	if (unlikely(delta.tv64 >= interval.tv64)) {
8095cee9645SThomas Gleixner 		s64 incr = ktime_to_ns(interval);
8105cee9645SThomas Gleixner 
8115cee9645SThomas Gleixner 		orun = ktime_divns(delta, incr);
8125cee9645SThomas Gleixner 		hrtimer_add_expires_ns(timer, incr * orun);
8135cee9645SThomas Gleixner 		if (hrtimer_get_expires_tv64(timer) > now.tv64)
8145cee9645SThomas Gleixner 			return orun;
8155cee9645SThomas Gleixner 		/*
8165cee9645SThomas Gleixner 		 * This (and the ktime_add() below) is the
8175cee9645SThomas Gleixner 		 * correction for exact:
8185cee9645SThomas Gleixner 		 */
8195cee9645SThomas Gleixner 		orun++;
8205cee9645SThomas Gleixner 	}
8215cee9645SThomas Gleixner 	hrtimer_add_expires(timer, interval);
8225cee9645SThomas Gleixner 
8235cee9645SThomas Gleixner 	return orun;
8245cee9645SThomas Gleixner }
8255cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_forward);
8265cee9645SThomas Gleixner 
8275cee9645SThomas Gleixner /*
8285cee9645SThomas Gleixner  * enqueue_hrtimer - internal function to (re)start a timer
8295cee9645SThomas Gleixner  *
8305cee9645SThomas Gleixner  * The timer is inserted in expiry order. Insertion into the
8315cee9645SThomas Gleixner  * red black tree is O(log(n)). Must hold the base lock.
8325cee9645SThomas Gleixner  *
8335cee9645SThomas Gleixner  * Returns 1 when the new timer is the leftmost timer in the tree.
8345cee9645SThomas Gleixner  */
8355cee9645SThomas Gleixner static int enqueue_hrtimer(struct hrtimer *timer,
8365cee9645SThomas Gleixner 			   struct hrtimer_clock_base *base)
8375cee9645SThomas Gleixner {
8385cee9645SThomas Gleixner 	debug_activate(timer);
8395cee9645SThomas Gleixner 
8405cee9645SThomas Gleixner 	base->cpu_base->active_bases |= 1 << base->index;
8415cee9645SThomas Gleixner 
8425cee9645SThomas Gleixner 	/*
8435cee9645SThomas Gleixner 	 * HRTIMER_STATE_ENQUEUED is or'ed to the current state to preserve the
8445cee9645SThomas Gleixner 	 * state of a possibly running callback.
8455cee9645SThomas Gleixner 	 */
8465cee9645SThomas Gleixner 	timer->state |= HRTIMER_STATE_ENQUEUED;
8475cee9645SThomas Gleixner 
848b97f44c9SThomas Gleixner 	return timerqueue_add(&base->active, &timer->node);
8495cee9645SThomas Gleixner }
8505cee9645SThomas Gleixner 
8515cee9645SThomas Gleixner /*
8525cee9645SThomas Gleixner  * __remove_hrtimer - internal function to remove a timer
8535cee9645SThomas Gleixner  *
8545cee9645SThomas Gleixner  * Caller must hold the base lock.
8555cee9645SThomas Gleixner  *
8565cee9645SThomas Gleixner  * High resolution timer mode reprograms the clock event device when the
8575cee9645SThomas Gleixner  * timer is the one which expires next. The caller can disable this by setting
8585cee9645SThomas Gleixner  * reprogram to zero. This is useful, when the context does a reprogramming
8595cee9645SThomas Gleixner  * anyway (e.g. timer interrupt)
8605cee9645SThomas Gleixner  */
8615cee9645SThomas Gleixner static void __remove_hrtimer(struct hrtimer *timer,
8625cee9645SThomas Gleixner 			     struct hrtimer_clock_base *base,
8635cee9645SThomas Gleixner 			     unsigned long newstate, int reprogram)
8645cee9645SThomas Gleixner {
865e19ffe8bSThomas Gleixner 	struct hrtimer_cpu_base *cpu_base = base->cpu_base;
866895bdfa7SThomas Gleixner 	unsigned int state = timer->state;
867e19ffe8bSThomas Gleixner 
868895bdfa7SThomas Gleixner 	timer->state = newstate;
869895bdfa7SThomas Gleixner 	if (!(state & HRTIMER_STATE_ENQUEUED))
870895bdfa7SThomas Gleixner 		return;
8715cee9645SThomas Gleixner 
872b97f44c9SThomas Gleixner 	if (!timerqueue_del(&base->active, &timer->node))
873e19ffe8bSThomas Gleixner 		cpu_base->active_bases &= ~(1 << base->index);
874d9f0acdeSViresh Kumar 
8755cee9645SThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
876895bdfa7SThomas Gleixner 	/*
877895bdfa7SThomas Gleixner 	 * Note: If reprogram is false we do not update
878895bdfa7SThomas Gleixner 	 * cpu_base->next_timer. This happens when we remove the first
879895bdfa7SThomas Gleixner 	 * timer on a remote cpu. No harm as we never dereference
880895bdfa7SThomas Gleixner 	 * cpu_base->next_timer. So the worst thing what can happen is
881895bdfa7SThomas Gleixner 	 * an superflous call to hrtimer_force_reprogram() on the
882895bdfa7SThomas Gleixner 	 * remote cpu later on if the same timer gets enqueued again.
883895bdfa7SThomas Gleixner 	 */
884895bdfa7SThomas Gleixner 	if (reprogram && timer == cpu_base->next_timer)
885e19ffe8bSThomas Gleixner 		hrtimer_force_reprogram(cpu_base, 1);
8865cee9645SThomas Gleixner #endif
8875cee9645SThomas Gleixner }
8885cee9645SThomas Gleixner 
8895cee9645SThomas Gleixner /*
8905cee9645SThomas Gleixner  * remove hrtimer, called with base lock held
8915cee9645SThomas Gleixner  */
8925cee9645SThomas Gleixner static inline int
8935cee9645SThomas Gleixner remove_hrtimer(struct hrtimer *timer, struct hrtimer_clock_base *base)
8945cee9645SThomas Gleixner {
8955cee9645SThomas Gleixner 	if (hrtimer_is_queued(timer)) {
8965cee9645SThomas Gleixner 		unsigned long state;
8975cee9645SThomas Gleixner 		int reprogram;
8985cee9645SThomas Gleixner 
8995cee9645SThomas Gleixner 		/*
9005cee9645SThomas Gleixner 		 * Remove the timer and force reprogramming when high
9015cee9645SThomas Gleixner 		 * resolution mode is active and the timer is on the current
9025cee9645SThomas Gleixner 		 * CPU. If we remove a timer on another CPU, reprogramming is
9035cee9645SThomas Gleixner 		 * skipped. The interrupt event on this CPU is fired and
9045cee9645SThomas Gleixner 		 * reprogramming happens in the interrupt handler. This is a
9055cee9645SThomas Gleixner 		 * rare case and less expensive than a smp call.
9065cee9645SThomas Gleixner 		 */
9075cee9645SThomas Gleixner 		debug_deactivate(timer);
9085cee9645SThomas Gleixner 		timer_stats_hrtimer_clear_start_info(timer);
909dc5df73bSChristoph Lameter 		reprogram = base->cpu_base == this_cpu_ptr(&hrtimer_bases);
9105cee9645SThomas Gleixner 		/*
9115cee9645SThomas Gleixner 		 * We must preserve the CALLBACK state flag here,
9125cee9645SThomas Gleixner 		 * otherwise we could move the timer base in
9135cee9645SThomas Gleixner 		 * switch_hrtimer_base.
9145cee9645SThomas Gleixner 		 */
9155cee9645SThomas Gleixner 		state = timer->state & HRTIMER_STATE_CALLBACK;
9165cee9645SThomas Gleixner 		__remove_hrtimer(timer, base, state, reprogram);
9175cee9645SThomas Gleixner 		return 1;
9185cee9645SThomas Gleixner 	}
9195cee9645SThomas Gleixner 	return 0;
9205cee9645SThomas Gleixner }
9215cee9645SThomas Gleixner 
92258f1f803SThomas Gleixner /**
92358f1f803SThomas Gleixner  * hrtimer_start_range_ns - (re)start an hrtimer on the current CPU
92458f1f803SThomas Gleixner  * @timer:	the timer to be added
92558f1f803SThomas Gleixner  * @tim:	expiry time
92658f1f803SThomas Gleixner  * @delta_ns:	"slack" range for the timer
92758f1f803SThomas Gleixner  * @mode:	expiry mode: absolute (HRTIMER_MODE_ABS) or
92858f1f803SThomas Gleixner  *		relative (HRTIMER_MODE_REL)
92958f1f803SThomas Gleixner  */
93061699e13SThomas Gleixner void hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
93158f1f803SThomas Gleixner 			    unsigned long delta_ns, const enum hrtimer_mode mode)
9325cee9645SThomas Gleixner {
9335cee9645SThomas Gleixner 	struct hrtimer_clock_base *base, *new_base;
9345cee9645SThomas Gleixner 	unsigned long flags;
93561699e13SThomas Gleixner 	int leftmost;
9365cee9645SThomas Gleixner 
9375cee9645SThomas Gleixner 	base = lock_hrtimer_base(timer, &flags);
9385cee9645SThomas Gleixner 
9395cee9645SThomas Gleixner 	/* Remove an active timer from the queue: */
94061699e13SThomas Gleixner 	remove_hrtimer(timer, base);
9415cee9645SThomas Gleixner 
9425cee9645SThomas Gleixner 	if (mode & HRTIMER_MODE_REL) {
9435cee9645SThomas Gleixner 		tim = ktime_add_safe(tim, base->get_time());
9445cee9645SThomas Gleixner 		/*
9455cee9645SThomas Gleixner 		 * CONFIG_TIME_LOW_RES is a temporary way for architectures
9465cee9645SThomas Gleixner 		 * to signal that they simply return xtime in
9475cee9645SThomas Gleixner 		 * do_gettimeoffset(). In this case we want to round up by
9485cee9645SThomas Gleixner 		 * resolution when starting a relative timer, to avoid short
9495cee9645SThomas Gleixner 		 * timeouts. This will go away with the GTOD framework.
9505cee9645SThomas Gleixner 		 */
9515cee9645SThomas Gleixner #ifdef CONFIG_TIME_LOW_RES
952398ca17fSThomas Gleixner 		tim = ktime_add_safe(tim, ktime_set(0, hrtimer_resolution));
9535cee9645SThomas Gleixner #endif
9545cee9645SThomas Gleixner 	}
9555cee9645SThomas Gleixner 
9565cee9645SThomas Gleixner 	hrtimer_set_expires_range_ns(timer, tim, delta_ns);
9575cee9645SThomas Gleixner 
9585cee9645SThomas Gleixner 	/* Switch the timer base, if necessary: */
9595cee9645SThomas Gleixner 	new_base = switch_hrtimer_base(timer, base, mode & HRTIMER_MODE_PINNED);
9605cee9645SThomas Gleixner 
9615cee9645SThomas Gleixner 	timer_stats_hrtimer_set_start_info(timer);
9625cee9645SThomas Gleixner 
9635cee9645SThomas Gleixner 	leftmost = enqueue_hrtimer(timer, new_base);
96461699e13SThomas Gleixner 	if (!leftmost)
96561699e13SThomas Gleixner 		goto unlock;
96649a2a075SViresh Kumar 
96749a2a075SViresh Kumar 	if (!hrtimer_is_hres_active(timer)) {
96849a2a075SViresh Kumar 		/*
96949a2a075SViresh Kumar 		 * Kick to reschedule the next tick to handle the new timer
97049a2a075SViresh Kumar 		 * on dynticks target.
97149a2a075SViresh Kumar 		 */
97249a2a075SViresh Kumar 		wake_up_nohz_cpu(new_base->cpu_base->cpu);
9735cee9645SThomas Gleixner 	} else {
974c6eb3f70SThomas Gleixner 		hrtimer_reprogram(timer, new_base);
9755cee9645SThomas Gleixner 	}
97661699e13SThomas Gleixner unlock:
9775cee9645SThomas Gleixner 	unlock_hrtimer_base(timer, &flags);
9785cee9645SThomas Gleixner }
9795cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_start_range_ns);
9805cee9645SThomas Gleixner 
9815cee9645SThomas Gleixner /**
9825cee9645SThomas Gleixner  * hrtimer_try_to_cancel - try to deactivate a timer
9835cee9645SThomas Gleixner  * @timer:	hrtimer to stop
9845cee9645SThomas Gleixner  *
9855cee9645SThomas Gleixner  * Returns:
9865cee9645SThomas Gleixner  *  0 when the timer was not active
9875cee9645SThomas Gleixner  *  1 when the timer was active
9885cee9645SThomas Gleixner  * -1 when the timer is currently excuting the callback function and
9895cee9645SThomas Gleixner  *    cannot be stopped
9905cee9645SThomas Gleixner  */
9915cee9645SThomas Gleixner int hrtimer_try_to_cancel(struct hrtimer *timer)
9925cee9645SThomas Gleixner {
9935cee9645SThomas Gleixner 	struct hrtimer_clock_base *base;
9945cee9645SThomas Gleixner 	unsigned long flags;
9955cee9645SThomas Gleixner 	int ret = -1;
9965cee9645SThomas Gleixner 
99719d9f422SThomas Gleixner 	/*
99819d9f422SThomas Gleixner 	 * Check lockless first. If the timer is not active (neither
99919d9f422SThomas Gleixner 	 * enqueued nor running the callback, nothing to do here.  The
100019d9f422SThomas Gleixner 	 * base lock does not serialize against a concurrent enqueue,
100119d9f422SThomas Gleixner 	 * so we can avoid taking it.
100219d9f422SThomas Gleixner 	 */
100319d9f422SThomas Gleixner 	if (!hrtimer_active(timer))
100419d9f422SThomas Gleixner 		return 0;
100519d9f422SThomas Gleixner 
10065cee9645SThomas Gleixner 	base = lock_hrtimer_base(timer, &flags);
10075cee9645SThomas Gleixner 
10085cee9645SThomas Gleixner 	if (!hrtimer_callback_running(timer))
10095cee9645SThomas Gleixner 		ret = remove_hrtimer(timer, base);
10105cee9645SThomas Gleixner 
10115cee9645SThomas Gleixner 	unlock_hrtimer_base(timer, &flags);
10125cee9645SThomas Gleixner 
10135cee9645SThomas Gleixner 	return ret;
10145cee9645SThomas Gleixner 
10155cee9645SThomas Gleixner }
10165cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_try_to_cancel);
10175cee9645SThomas Gleixner 
10185cee9645SThomas Gleixner /**
10195cee9645SThomas Gleixner  * hrtimer_cancel - cancel a timer and wait for the handler to finish.
10205cee9645SThomas Gleixner  * @timer:	the timer to be cancelled
10215cee9645SThomas Gleixner  *
10225cee9645SThomas Gleixner  * Returns:
10235cee9645SThomas Gleixner  *  0 when the timer was not active
10245cee9645SThomas Gleixner  *  1 when the timer was active
10255cee9645SThomas Gleixner  */
10265cee9645SThomas Gleixner int hrtimer_cancel(struct hrtimer *timer)
10275cee9645SThomas Gleixner {
10285cee9645SThomas Gleixner 	for (;;) {
10295cee9645SThomas Gleixner 		int ret = hrtimer_try_to_cancel(timer);
10305cee9645SThomas Gleixner 
10315cee9645SThomas Gleixner 		if (ret >= 0)
10325cee9645SThomas Gleixner 			return ret;
10335cee9645SThomas Gleixner 		cpu_relax();
10345cee9645SThomas Gleixner 	}
10355cee9645SThomas Gleixner }
10365cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_cancel);
10375cee9645SThomas Gleixner 
10385cee9645SThomas Gleixner /**
10395cee9645SThomas Gleixner  * hrtimer_get_remaining - get remaining time for the timer
10405cee9645SThomas Gleixner  * @timer:	the timer to read
10415cee9645SThomas Gleixner  */
10425cee9645SThomas Gleixner ktime_t hrtimer_get_remaining(const struct hrtimer *timer)
10435cee9645SThomas Gleixner {
10445cee9645SThomas Gleixner 	unsigned long flags;
10455cee9645SThomas Gleixner 	ktime_t rem;
10465cee9645SThomas Gleixner 
10475cee9645SThomas Gleixner 	lock_hrtimer_base(timer, &flags);
10485cee9645SThomas Gleixner 	rem = hrtimer_expires_remaining(timer);
10495cee9645SThomas Gleixner 	unlock_hrtimer_base(timer, &flags);
10505cee9645SThomas Gleixner 
10515cee9645SThomas Gleixner 	return rem;
10525cee9645SThomas Gleixner }
10535cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_get_remaining);
10545cee9645SThomas Gleixner 
10555cee9645SThomas Gleixner #ifdef CONFIG_NO_HZ_COMMON
10565cee9645SThomas Gleixner /**
10575cee9645SThomas Gleixner  * hrtimer_get_next_event - get the time until next expiry event
10585cee9645SThomas Gleixner  *
1059c1ad348bSThomas Gleixner  * Returns the next expiry time or KTIME_MAX if no timer is pending.
10605cee9645SThomas Gleixner  */
1061c1ad348bSThomas Gleixner u64 hrtimer_get_next_event(void)
10625cee9645SThomas Gleixner {
1063dc5df73bSChristoph Lameter 	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
1064c1ad348bSThomas Gleixner 	u64 expires = KTIME_MAX;
10655cee9645SThomas Gleixner 	unsigned long flags;
10665cee9645SThomas Gleixner 
10675cee9645SThomas Gleixner 	raw_spin_lock_irqsave(&cpu_base->lock, flags);
10685cee9645SThomas Gleixner 
1069e19ffe8bSThomas Gleixner 	if (!__hrtimer_hres_active(cpu_base))
1070c1ad348bSThomas Gleixner 		expires = __hrtimer_get_next_event(cpu_base).tv64;
10715cee9645SThomas Gleixner 
10725cee9645SThomas Gleixner 	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
10735cee9645SThomas Gleixner 
1074c1ad348bSThomas Gleixner 	return expires;
10755cee9645SThomas Gleixner }
10765cee9645SThomas Gleixner #endif
10775cee9645SThomas Gleixner 
10785cee9645SThomas Gleixner static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
10795cee9645SThomas Gleixner 			   enum hrtimer_mode mode)
10805cee9645SThomas Gleixner {
10815cee9645SThomas Gleixner 	struct hrtimer_cpu_base *cpu_base;
10825cee9645SThomas Gleixner 	int base;
10835cee9645SThomas Gleixner 
10845cee9645SThomas Gleixner 	memset(timer, 0, sizeof(struct hrtimer));
10855cee9645SThomas Gleixner 
108622127e93SChristoph Lameter 	cpu_base = raw_cpu_ptr(&hrtimer_bases);
10875cee9645SThomas Gleixner 
10885cee9645SThomas Gleixner 	if (clock_id == CLOCK_REALTIME && mode != HRTIMER_MODE_ABS)
10895cee9645SThomas Gleixner 		clock_id = CLOCK_MONOTONIC;
10905cee9645SThomas Gleixner 
10915cee9645SThomas Gleixner 	base = hrtimer_clockid_to_base(clock_id);
10925cee9645SThomas Gleixner 	timer->base = &cpu_base->clock_base[base];
10935cee9645SThomas Gleixner 	timerqueue_init(&timer->node);
10945cee9645SThomas Gleixner 
10955cee9645SThomas Gleixner #ifdef CONFIG_TIMER_STATS
10965cee9645SThomas Gleixner 	timer->start_site = NULL;
10975cee9645SThomas Gleixner 	timer->start_pid = -1;
10985cee9645SThomas Gleixner 	memset(timer->start_comm, 0, TASK_COMM_LEN);
10995cee9645SThomas Gleixner #endif
11005cee9645SThomas Gleixner }
11015cee9645SThomas Gleixner 
11025cee9645SThomas Gleixner /**
11035cee9645SThomas Gleixner  * hrtimer_init - initialize a timer to the given clock
11045cee9645SThomas Gleixner  * @timer:	the timer to be initialized
11055cee9645SThomas Gleixner  * @clock_id:	the clock to be used
11065cee9645SThomas Gleixner  * @mode:	timer mode abs/rel
11075cee9645SThomas Gleixner  */
11085cee9645SThomas Gleixner void hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
11095cee9645SThomas Gleixner 		  enum hrtimer_mode mode)
11105cee9645SThomas Gleixner {
11115cee9645SThomas Gleixner 	debug_init(timer, clock_id, mode);
11125cee9645SThomas Gleixner 	__hrtimer_init(timer, clock_id, mode);
11135cee9645SThomas Gleixner }
11145cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_init);
11155cee9645SThomas Gleixner 
111621d6d52aSThomas Gleixner static void __run_hrtimer(struct hrtimer_cpu_base *cpu_base,
111721d6d52aSThomas Gleixner 			  struct hrtimer_clock_base *base,
111821d6d52aSThomas Gleixner 			  struct hrtimer *timer, ktime_t *now)
11195cee9645SThomas Gleixner {
11205cee9645SThomas Gleixner 	enum hrtimer_restart (*fn)(struct hrtimer *);
11215cee9645SThomas Gleixner 	int restart;
11225cee9645SThomas Gleixner 
11235cee9645SThomas Gleixner 	WARN_ON(!irqs_disabled());
11245cee9645SThomas Gleixner 
11255cee9645SThomas Gleixner 	debug_deactivate(timer);
11265cee9645SThomas Gleixner 	__remove_hrtimer(timer, base, HRTIMER_STATE_CALLBACK, 0);
11275cee9645SThomas Gleixner 	timer_stats_account_hrtimer(timer);
11285cee9645SThomas Gleixner 	fn = timer->function;
11295cee9645SThomas Gleixner 
11305cee9645SThomas Gleixner 	/*
11315cee9645SThomas Gleixner 	 * Because we run timers from hardirq context, there is no chance
11325cee9645SThomas Gleixner 	 * they get migrated to another cpu, therefore its safe to unlock
11335cee9645SThomas Gleixner 	 * the timer base.
11345cee9645SThomas Gleixner 	 */
11355cee9645SThomas Gleixner 	raw_spin_unlock(&cpu_base->lock);
11365cee9645SThomas Gleixner 	trace_hrtimer_expire_entry(timer, now);
11375cee9645SThomas Gleixner 	restart = fn(timer);
11385cee9645SThomas Gleixner 	trace_hrtimer_expire_exit(timer);
11395cee9645SThomas Gleixner 	raw_spin_lock(&cpu_base->lock);
11405cee9645SThomas Gleixner 
11415cee9645SThomas Gleixner 	/*
11425cee9645SThomas Gleixner 	 * Note: We clear the CALLBACK bit after enqueue_hrtimer and
11435cee9645SThomas Gleixner 	 * we do not reprogramm the event hardware. Happens either in
11445cee9645SThomas Gleixner 	 * hrtimer_start_range_ns() or in hrtimer_interrupt()
1145*5de2755cSPeter Zijlstra 	 *
1146*5de2755cSPeter Zijlstra 	 * Note: Because we dropped the cpu_base->lock above,
1147*5de2755cSPeter Zijlstra 	 * hrtimer_start_range_ns() can have popped in and enqueued the timer
1148*5de2755cSPeter Zijlstra 	 * for us already.
11495cee9645SThomas Gleixner 	 */
1150*5de2755cSPeter Zijlstra 	if (restart != HRTIMER_NORESTART &&
1151*5de2755cSPeter Zijlstra 	    !(timer->state & HRTIMER_STATE_ENQUEUED))
11525cee9645SThomas Gleixner 		enqueue_hrtimer(timer, base);
11535cee9645SThomas Gleixner 
11545cee9645SThomas Gleixner 	WARN_ON_ONCE(!(timer->state & HRTIMER_STATE_CALLBACK));
11555cee9645SThomas Gleixner 
11565cee9645SThomas Gleixner 	timer->state &= ~HRTIMER_STATE_CALLBACK;
11575cee9645SThomas Gleixner }
11585cee9645SThomas Gleixner 
115921d6d52aSThomas Gleixner static void __hrtimer_run_queues(struct hrtimer_cpu_base *cpu_base, ktime_t now)
11605cee9645SThomas Gleixner {
116134aee88aSThomas Gleixner 	struct hrtimer_clock_base *base = cpu_base->clock_base;
116234aee88aSThomas Gleixner 	unsigned int active = cpu_base->active_bases;
11635cee9645SThomas Gleixner 
116434aee88aSThomas Gleixner 	for (; active; base++, active >>= 1) {
11655cee9645SThomas Gleixner 		struct timerqueue_node *node;
11665cee9645SThomas Gleixner 		ktime_t basenow;
11675cee9645SThomas Gleixner 
116834aee88aSThomas Gleixner 		if (!(active & 0x01))
11695cee9645SThomas Gleixner 			continue;
11705cee9645SThomas Gleixner 
11715cee9645SThomas Gleixner 		basenow = ktime_add(now, base->offset);
11725cee9645SThomas Gleixner 
11735cee9645SThomas Gleixner 		while ((node = timerqueue_getnext(&base->active))) {
11745cee9645SThomas Gleixner 			struct hrtimer *timer;
11755cee9645SThomas Gleixner 
11765cee9645SThomas Gleixner 			timer = container_of(node, struct hrtimer, node);
11775cee9645SThomas Gleixner 
11785cee9645SThomas Gleixner 			/*
11795cee9645SThomas Gleixner 			 * The immediate goal for using the softexpires is
11805cee9645SThomas Gleixner 			 * minimizing wakeups, not running timers at the
11815cee9645SThomas Gleixner 			 * earliest interrupt after their soft expiration.
11825cee9645SThomas Gleixner 			 * This allows us to avoid using a Priority Search
11835cee9645SThomas Gleixner 			 * Tree, which can answer a stabbing querry for
11845cee9645SThomas Gleixner 			 * overlapping intervals and instead use the simple
11855cee9645SThomas Gleixner 			 * BST we already have.
11865cee9645SThomas Gleixner 			 * We don't add extra wakeups by delaying timers that
11875cee9645SThomas Gleixner 			 * are right-of a not yet expired timer, because that
11885cee9645SThomas Gleixner 			 * timer will have to trigger a wakeup anyway.
11895cee9645SThomas Gleixner 			 */
11909bc74919SThomas Gleixner 			if (basenow.tv64 < hrtimer_get_softexpires_tv64(timer))
11915cee9645SThomas Gleixner 				break;
11925cee9645SThomas Gleixner 
119321d6d52aSThomas Gleixner 			__run_hrtimer(cpu_base, base, timer, &basenow);
11945cee9645SThomas Gleixner 		}
11955cee9645SThomas Gleixner 	}
119621d6d52aSThomas Gleixner }
119721d6d52aSThomas Gleixner 
119821d6d52aSThomas Gleixner #ifdef CONFIG_HIGH_RES_TIMERS
119921d6d52aSThomas Gleixner 
120021d6d52aSThomas Gleixner /*
120121d6d52aSThomas Gleixner  * High resolution timer interrupt
120221d6d52aSThomas Gleixner  * Called with interrupts disabled
120321d6d52aSThomas Gleixner  */
120421d6d52aSThomas Gleixner void hrtimer_interrupt(struct clock_event_device *dev)
120521d6d52aSThomas Gleixner {
120621d6d52aSThomas Gleixner 	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
120721d6d52aSThomas Gleixner 	ktime_t expires_next, now, entry_time, delta;
120821d6d52aSThomas Gleixner 	int retries = 0;
120921d6d52aSThomas Gleixner 
121021d6d52aSThomas Gleixner 	BUG_ON(!cpu_base->hres_active);
121121d6d52aSThomas Gleixner 	cpu_base->nr_events++;
121221d6d52aSThomas Gleixner 	dev->next_event.tv64 = KTIME_MAX;
121321d6d52aSThomas Gleixner 
121421d6d52aSThomas Gleixner 	raw_spin_lock(&cpu_base->lock);
121521d6d52aSThomas Gleixner 	entry_time = now = hrtimer_update_base(cpu_base);
121621d6d52aSThomas Gleixner retry:
121721d6d52aSThomas Gleixner 	cpu_base->in_hrtirq = 1;
121821d6d52aSThomas Gleixner 	/*
121921d6d52aSThomas Gleixner 	 * We set expires_next to KTIME_MAX here with cpu_base->lock
122021d6d52aSThomas Gleixner 	 * held to prevent that a timer is enqueued in our queue via
122121d6d52aSThomas Gleixner 	 * the migration code. This does not affect enqueueing of
122221d6d52aSThomas Gleixner 	 * timers which run their callback and need to be requeued on
122321d6d52aSThomas Gleixner 	 * this CPU.
122421d6d52aSThomas Gleixner 	 */
122521d6d52aSThomas Gleixner 	cpu_base->expires_next.tv64 = KTIME_MAX;
122621d6d52aSThomas Gleixner 
122721d6d52aSThomas Gleixner 	__hrtimer_run_queues(cpu_base, now);
122821d6d52aSThomas Gleixner 
12299bc74919SThomas Gleixner 	/* Reevaluate the clock bases for the next expiry */
12309bc74919SThomas Gleixner 	expires_next = __hrtimer_get_next_event(cpu_base);
12315cee9645SThomas Gleixner 	/*
12325cee9645SThomas Gleixner 	 * Store the new expiry value so the migration code can verify
12335cee9645SThomas Gleixner 	 * against it.
12345cee9645SThomas Gleixner 	 */
12355cee9645SThomas Gleixner 	cpu_base->expires_next = expires_next;
12369bc74919SThomas Gleixner 	cpu_base->in_hrtirq = 0;
12375cee9645SThomas Gleixner 	raw_spin_unlock(&cpu_base->lock);
12385cee9645SThomas Gleixner 
12395cee9645SThomas Gleixner 	/* Reprogramming necessary ? */
12405cee9645SThomas Gleixner 	if (expires_next.tv64 == KTIME_MAX ||
12415cee9645SThomas Gleixner 	    !tick_program_event(expires_next, 0)) {
12425cee9645SThomas Gleixner 		cpu_base->hang_detected = 0;
12435cee9645SThomas Gleixner 		return;
12445cee9645SThomas Gleixner 	}
12455cee9645SThomas Gleixner 
12465cee9645SThomas Gleixner 	/*
12475cee9645SThomas Gleixner 	 * The next timer was already expired due to:
12485cee9645SThomas Gleixner 	 * - tracing
12495cee9645SThomas Gleixner 	 * - long lasting callbacks
12505cee9645SThomas Gleixner 	 * - being scheduled away when running in a VM
12515cee9645SThomas Gleixner 	 *
12525cee9645SThomas Gleixner 	 * We need to prevent that we loop forever in the hrtimer
12535cee9645SThomas Gleixner 	 * interrupt routine. We give it 3 attempts to avoid
12545cee9645SThomas Gleixner 	 * overreacting on some spurious event.
12555cee9645SThomas Gleixner 	 *
12565cee9645SThomas Gleixner 	 * Acquire base lock for updating the offsets and retrieving
12575cee9645SThomas Gleixner 	 * the current time.
12585cee9645SThomas Gleixner 	 */
12595cee9645SThomas Gleixner 	raw_spin_lock(&cpu_base->lock);
12605cee9645SThomas Gleixner 	now = hrtimer_update_base(cpu_base);
12615cee9645SThomas Gleixner 	cpu_base->nr_retries++;
12625cee9645SThomas Gleixner 	if (++retries < 3)
12635cee9645SThomas Gleixner 		goto retry;
12645cee9645SThomas Gleixner 	/*
12655cee9645SThomas Gleixner 	 * Give the system a chance to do something else than looping
12665cee9645SThomas Gleixner 	 * here. We stored the entry time, so we know exactly how long
12675cee9645SThomas Gleixner 	 * we spent here. We schedule the next event this amount of
12685cee9645SThomas Gleixner 	 * time away.
12695cee9645SThomas Gleixner 	 */
12705cee9645SThomas Gleixner 	cpu_base->nr_hangs++;
12715cee9645SThomas Gleixner 	cpu_base->hang_detected = 1;
12725cee9645SThomas Gleixner 	raw_spin_unlock(&cpu_base->lock);
12735cee9645SThomas Gleixner 	delta = ktime_sub(now, entry_time);
1274a6ffebceSThomas Gleixner 	if ((unsigned int)delta.tv64 > cpu_base->max_hang_time)
1275a6ffebceSThomas Gleixner 		cpu_base->max_hang_time = (unsigned int) delta.tv64;
12765cee9645SThomas Gleixner 	/*
12775cee9645SThomas Gleixner 	 * Limit it to a sensible value as we enforce a longer
12785cee9645SThomas Gleixner 	 * delay. Give the CPU at least 100ms to catch up.
12795cee9645SThomas Gleixner 	 */
12805cee9645SThomas Gleixner 	if (delta.tv64 > 100 * NSEC_PER_MSEC)
12815cee9645SThomas Gleixner 		expires_next = ktime_add_ns(now, 100 * NSEC_PER_MSEC);
12825cee9645SThomas Gleixner 	else
12835cee9645SThomas Gleixner 		expires_next = ktime_add(now, delta);
12845cee9645SThomas Gleixner 	tick_program_event(expires_next, 1);
12855cee9645SThomas Gleixner 	printk_once(KERN_WARNING "hrtimer: interrupt took %llu ns\n",
12865cee9645SThomas Gleixner 		    ktime_to_ns(delta));
12875cee9645SThomas Gleixner }
12885cee9645SThomas Gleixner 
12895cee9645SThomas Gleixner /*
12905cee9645SThomas Gleixner  * local version of hrtimer_peek_ahead_timers() called with interrupts
12915cee9645SThomas Gleixner  * disabled.
12925cee9645SThomas Gleixner  */
1293c6eb3f70SThomas Gleixner static inline void __hrtimer_peek_ahead_timers(void)
12945cee9645SThomas Gleixner {
12955cee9645SThomas Gleixner 	struct tick_device *td;
12965cee9645SThomas Gleixner 
12975cee9645SThomas Gleixner 	if (!hrtimer_hres_active())
12985cee9645SThomas Gleixner 		return;
12995cee9645SThomas Gleixner 
130022127e93SChristoph Lameter 	td = this_cpu_ptr(&tick_cpu_device);
13015cee9645SThomas Gleixner 	if (td && td->evtdev)
13025cee9645SThomas Gleixner 		hrtimer_interrupt(td->evtdev);
13035cee9645SThomas Gleixner }
13045cee9645SThomas Gleixner 
13055cee9645SThomas Gleixner #else /* CONFIG_HIGH_RES_TIMERS */
13065cee9645SThomas Gleixner 
13075cee9645SThomas Gleixner static inline void __hrtimer_peek_ahead_timers(void) { }
13085cee9645SThomas Gleixner 
13095cee9645SThomas Gleixner #endif	/* !CONFIG_HIGH_RES_TIMERS */
13105cee9645SThomas Gleixner 
13115cee9645SThomas Gleixner /*
1312c6eb3f70SThomas Gleixner  * Called from run_local_timers in hardirq context every jiffy
13135cee9645SThomas Gleixner  */
13145cee9645SThomas Gleixner void hrtimer_run_queues(void)
13155cee9645SThomas Gleixner {
1316dc5df73bSChristoph Lameter 	struct hrtimer_cpu_base *cpu_base = this_cpu_ptr(&hrtimer_bases);
131721d6d52aSThomas Gleixner 	ktime_t now;
13185cee9645SThomas Gleixner 
1319e19ffe8bSThomas Gleixner 	if (__hrtimer_hres_active(cpu_base))
13205cee9645SThomas Gleixner 		return;
13215cee9645SThomas Gleixner 
1322c6eb3f70SThomas Gleixner 	/*
1323c6eb3f70SThomas Gleixner 	 * This _is_ ugly: We have to check periodically, whether we
1324c6eb3f70SThomas Gleixner 	 * can switch to highres and / or nohz mode. The clocksource
1325c6eb3f70SThomas Gleixner 	 * switch happens with xtime_lock held. Notification from
1326c6eb3f70SThomas Gleixner 	 * there only sets the check bit in the tick_oneshot code,
1327c6eb3f70SThomas Gleixner 	 * otherwise we might deadlock vs. xtime_lock.
1328c6eb3f70SThomas Gleixner 	 */
1329c6eb3f70SThomas Gleixner 	if (tick_check_oneshot_change(!hrtimer_is_hres_enabled())) {
1330c6eb3f70SThomas Gleixner 		hrtimer_switch_to_hres();
1331c6eb3f70SThomas Gleixner 		return;
1332c6eb3f70SThomas Gleixner 	}
1333c6eb3f70SThomas Gleixner 
13345cee9645SThomas Gleixner 	raw_spin_lock(&cpu_base->lock);
133521d6d52aSThomas Gleixner 	now = hrtimer_update_base(cpu_base);
133621d6d52aSThomas Gleixner 	__hrtimer_run_queues(cpu_base, now);
13375cee9645SThomas Gleixner 	raw_spin_unlock(&cpu_base->lock);
13385cee9645SThomas Gleixner }
13395cee9645SThomas Gleixner 
13405cee9645SThomas Gleixner /*
13415cee9645SThomas Gleixner  * Sleep related functions:
13425cee9645SThomas Gleixner  */
13435cee9645SThomas Gleixner static enum hrtimer_restart hrtimer_wakeup(struct hrtimer *timer)
13445cee9645SThomas Gleixner {
13455cee9645SThomas Gleixner 	struct hrtimer_sleeper *t =
13465cee9645SThomas Gleixner 		container_of(timer, struct hrtimer_sleeper, timer);
13475cee9645SThomas Gleixner 	struct task_struct *task = t->task;
13485cee9645SThomas Gleixner 
13495cee9645SThomas Gleixner 	t->task = NULL;
13505cee9645SThomas Gleixner 	if (task)
13515cee9645SThomas Gleixner 		wake_up_process(task);
13525cee9645SThomas Gleixner 
13535cee9645SThomas Gleixner 	return HRTIMER_NORESTART;
13545cee9645SThomas Gleixner }
13555cee9645SThomas Gleixner 
13565cee9645SThomas Gleixner void hrtimer_init_sleeper(struct hrtimer_sleeper *sl, struct task_struct *task)
13575cee9645SThomas Gleixner {
13585cee9645SThomas Gleixner 	sl->timer.function = hrtimer_wakeup;
13595cee9645SThomas Gleixner 	sl->task = task;
13605cee9645SThomas Gleixner }
13615cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(hrtimer_init_sleeper);
13625cee9645SThomas Gleixner 
13635cee9645SThomas Gleixner static int __sched do_nanosleep(struct hrtimer_sleeper *t, enum hrtimer_mode mode)
13645cee9645SThomas Gleixner {
13655cee9645SThomas Gleixner 	hrtimer_init_sleeper(t, current);
13665cee9645SThomas Gleixner 
13675cee9645SThomas Gleixner 	do {
13685cee9645SThomas Gleixner 		set_current_state(TASK_INTERRUPTIBLE);
13695cee9645SThomas Gleixner 		hrtimer_start_expires(&t->timer, mode);
13705cee9645SThomas Gleixner 
13715cee9645SThomas Gleixner 		if (likely(t->task))
13725cee9645SThomas Gleixner 			freezable_schedule();
13735cee9645SThomas Gleixner 
13745cee9645SThomas Gleixner 		hrtimer_cancel(&t->timer);
13755cee9645SThomas Gleixner 		mode = HRTIMER_MODE_ABS;
13765cee9645SThomas Gleixner 
13775cee9645SThomas Gleixner 	} while (t->task && !signal_pending(current));
13785cee9645SThomas Gleixner 
13795cee9645SThomas Gleixner 	__set_current_state(TASK_RUNNING);
13805cee9645SThomas Gleixner 
13815cee9645SThomas Gleixner 	return t->task == NULL;
13825cee9645SThomas Gleixner }
13835cee9645SThomas Gleixner 
13845cee9645SThomas Gleixner static int update_rmtp(struct hrtimer *timer, struct timespec __user *rmtp)
13855cee9645SThomas Gleixner {
13865cee9645SThomas Gleixner 	struct timespec rmt;
13875cee9645SThomas Gleixner 	ktime_t rem;
13885cee9645SThomas Gleixner 
13895cee9645SThomas Gleixner 	rem = hrtimer_expires_remaining(timer);
13905cee9645SThomas Gleixner 	if (rem.tv64 <= 0)
13915cee9645SThomas Gleixner 		return 0;
13925cee9645SThomas Gleixner 	rmt = ktime_to_timespec(rem);
13935cee9645SThomas Gleixner 
13945cee9645SThomas Gleixner 	if (copy_to_user(rmtp, &rmt, sizeof(*rmtp)))
13955cee9645SThomas Gleixner 		return -EFAULT;
13965cee9645SThomas Gleixner 
13975cee9645SThomas Gleixner 	return 1;
13985cee9645SThomas Gleixner }
13995cee9645SThomas Gleixner 
14005cee9645SThomas Gleixner long __sched hrtimer_nanosleep_restart(struct restart_block *restart)
14015cee9645SThomas Gleixner {
14025cee9645SThomas Gleixner 	struct hrtimer_sleeper t;
14035cee9645SThomas Gleixner 	struct timespec __user  *rmtp;
14045cee9645SThomas Gleixner 	int ret = 0;
14055cee9645SThomas Gleixner 
14065cee9645SThomas Gleixner 	hrtimer_init_on_stack(&t.timer, restart->nanosleep.clockid,
14075cee9645SThomas Gleixner 				HRTIMER_MODE_ABS);
14085cee9645SThomas Gleixner 	hrtimer_set_expires_tv64(&t.timer, restart->nanosleep.expires);
14095cee9645SThomas Gleixner 
14105cee9645SThomas Gleixner 	if (do_nanosleep(&t, HRTIMER_MODE_ABS))
14115cee9645SThomas Gleixner 		goto out;
14125cee9645SThomas Gleixner 
14135cee9645SThomas Gleixner 	rmtp = restart->nanosleep.rmtp;
14145cee9645SThomas Gleixner 	if (rmtp) {
14155cee9645SThomas Gleixner 		ret = update_rmtp(&t.timer, rmtp);
14165cee9645SThomas Gleixner 		if (ret <= 0)
14175cee9645SThomas Gleixner 			goto out;
14185cee9645SThomas Gleixner 	}
14195cee9645SThomas Gleixner 
14205cee9645SThomas Gleixner 	/* The other values in restart are already filled in */
14215cee9645SThomas Gleixner 	ret = -ERESTART_RESTARTBLOCK;
14225cee9645SThomas Gleixner out:
14235cee9645SThomas Gleixner 	destroy_hrtimer_on_stack(&t.timer);
14245cee9645SThomas Gleixner 	return ret;
14255cee9645SThomas Gleixner }
14265cee9645SThomas Gleixner 
14275cee9645SThomas Gleixner long hrtimer_nanosleep(struct timespec *rqtp, struct timespec __user *rmtp,
14285cee9645SThomas Gleixner 		       const enum hrtimer_mode mode, const clockid_t clockid)
14295cee9645SThomas Gleixner {
14305cee9645SThomas Gleixner 	struct restart_block *restart;
14315cee9645SThomas Gleixner 	struct hrtimer_sleeper t;
14325cee9645SThomas Gleixner 	int ret = 0;
14335cee9645SThomas Gleixner 	unsigned long slack;
14345cee9645SThomas Gleixner 
14355cee9645SThomas Gleixner 	slack = current->timer_slack_ns;
14365cee9645SThomas Gleixner 	if (dl_task(current) || rt_task(current))
14375cee9645SThomas Gleixner 		slack = 0;
14385cee9645SThomas Gleixner 
14395cee9645SThomas Gleixner 	hrtimer_init_on_stack(&t.timer, clockid, mode);
14405cee9645SThomas Gleixner 	hrtimer_set_expires_range_ns(&t.timer, timespec_to_ktime(*rqtp), slack);
14415cee9645SThomas Gleixner 	if (do_nanosleep(&t, mode))
14425cee9645SThomas Gleixner 		goto out;
14435cee9645SThomas Gleixner 
14445cee9645SThomas Gleixner 	/* Absolute timers do not update the rmtp value and restart: */
14455cee9645SThomas Gleixner 	if (mode == HRTIMER_MODE_ABS) {
14465cee9645SThomas Gleixner 		ret = -ERESTARTNOHAND;
14475cee9645SThomas Gleixner 		goto out;
14485cee9645SThomas Gleixner 	}
14495cee9645SThomas Gleixner 
14505cee9645SThomas Gleixner 	if (rmtp) {
14515cee9645SThomas Gleixner 		ret = update_rmtp(&t.timer, rmtp);
14525cee9645SThomas Gleixner 		if (ret <= 0)
14535cee9645SThomas Gleixner 			goto out;
14545cee9645SThomas Gleixner 	}
14555cee9645SThomas Gleixner 
1456f56141e3SAndy Lutomirski 	restart = &current->restart_block;
14575cee9645SThomas Gleixner 	restart->fn = hrtimer_nanosleep_restart;
14585cee9645SThomas Gleixner 	restart->nanosleep.clockid = t.timer.base->clockid;
14595cee9645SThomas Gleixner 	restart->nanosleep.rmtp = rmtp;
14605cee9645SThomas Gleixner 	restart->nanosleep.expires = hrtimer_get_expires_tv64(&t.timer);
14615cee9645SThomas Gleixner 
14625cee9645SThomas Gleixner 	ret = -ERESTART_RESTARTBLOCK;
14635cee9645SThomas Gleixner out:
14645cee9645SThomas Gleixner 	destroy_hrtimer_on_stack(&t.timer);
14655cee9645SThomas Gleixner 	return ret;
14665cee9645SThomas Gleixner }
14675cee9645SThomas Gleixner 
14685cee9645SThomas Gleixner SYSCALL_DEFINE2(nanosleep, struct timespec __user *, rqtp,
14695cee9645SThomas Gleixner 		struct timespec __user *, rmtp)
14705cee9645SThomas Gleixner {
14715cee9645SThomas Gleixner 	struct timespec tu;
14725cee9645SThomas Gleixner 
14735cee9645SThomas Gleixner 	if (copy_from_user(&tu, rqtp, sizeof(tu)))
14745cee9645SThomas Gleixner 		return -EFAULT;
14755cee9645SThomas Gleixner 
14765cee9645SThomas Gleixner 	if (!timespec_valid(&tu))
14775cee9645SThomas Gleixner 		return -EINVAL;
14785cee9645SThomas Gleixner 
14795cee9645SThomas Gleixner 	return hrtimer_nanosleep(&tu, rmtp, HRTIMER_MODE_REL, CLOCK_MONOTONIC);
14805cee9645SThomas Gleixner }
14815cee9645SThomas Gleixner 
14825cee9645SThomas Gleixner /*
14835cee9645SThomas Gleixner  * Functions related to boot-time initialization:
14845cee9645SThomas Gleixner  */
14855cee9645SThomas Gleixner static void init_hrtimers_cpu(int cpu)
14865cee9645SThomas Gleixner {
14875cee9645SThomas Gleixner 	struct hrtimer_cpu_base *cpu_base = &per_cpu(hrtimer_bases, cpu);
14885cee9645SThomas Gleixner 	int i;
14895cee9645SThomas Gleixner 
14905cee9645SThomas Gleixner 	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
14915cee9645SThomas Gleixner 		cpu_base->clock_base[i].cpu_base = cpu_base;
14925cee9645SThomas Gleixner 		timerqueue_init_head(&cpu_base->clock_base[i].active);
14935cee9645SThomas Gleixner 	}
14945cee9645SThomas Gleixner 
1495cddd0248SViresh Kumar 	cpu_base->cpu = cpu;
14965cee9645SThomas Gleixner 	hrtimer_init_hres(cpu_base);
14975cee9645SThomas Gleixner }
14985cee9645SThomas Gleixner 
14995cee9645SThomas Gleixner #ifdef CONFIG_HOTPLUG_CPU
15005cee9645SThomas Gleixner 
15015cee9645SThomas Gleixner static void migrate_hrtimer_list(struct hrtimer_clock_base *old_base,
15025cee9645SThomas Gleixner 				struct hrtimer_clock_base *new_base)
15035cee9645SThomas Gleixner {
15045cee9645SThomas Gleixner 	struct hrtimer *timer;
15055cee9645SThomas Gleixner 	struct timerqueue_node *node;
15065cee9645SThomas Gleixner 
15075cee9645SThomas Gleixner 	while ((node = timerqueue_getnext(&old_base->active))) {
15085cee9645SThomas Gleixner 		timer = container_of(node, struct hrtimer, node);
15095cee9645SThomas Gleixner 		BUG_ON(hrtimer_callback_running(timer));
15105cee9645SThomas Gleixner 		debug_deactivate(timer);
15115cee9645SThomas Gleixner 
15125cee9645SThomas Gleixner 		/*
15135cee9645SThomas Gleixner 		 * Mark it as STATE_MIGRATE not INACTIVE otherwise the
15145cee9645SThomas Gleixner 		 * timer could be seen as !active and just vanish away
15155cee9645SThomas Gleixner 		 * under us on another CPU
15165cee9645SThomas Gleixner 		 */
15175cee9645SThomas Gleixner 		__remove_hrtimer(timer, old_base, HRTIMER_STATE_MIGRATE, 0);
15185cee9645SThomas Gleixner 		timer->base = new_base;
15195cee9645SThomas Gleixner 		/*
15205cee9645SThomas Gleixner 		 * Enqueue the timers on the new cpu. This does not
15215cee9645SThomas Gleixner 		 * reprogram the event device in case the timer
15225cee9645SThomas Gleixner 		 * expires before the earliest on this CPU, but we run
15235cee9645SThomas Gleixner 		 * hrtimer_interrupt after we migrated everything to
15245cee9645SThomas Gleixner 		 * sort out already expired timers and reprogram the
15255cee9645SThomas Gleixner 		 * event device.
15265cee9645SThomas Gleixner 		 */
15275cee9645SThomas Gleixner 		enqueue_hrtimer(timer, new_base);
15285cee9645SThomas Gleixner 
15295cee9645SThomas Gleixner 		/* Clear the migration state bit */
15305cee9645SThomas Gleixner 		timer->state &= ~HRTIMER_STATE_MIGRATE;
15315cee9645SThomas Gleixner 	}
15325cee9645SThomas Gleixner }
15335cee9645SThomas Gleixner 
15345cee9645SThomas Gleixner static void migrate_hrtimers(int scpu)
15355cee9645SThomas Gleixner {
15365cee9645SThomas Gleixner 	struct hrtimer_cpu_base *old_base, *new_base;
15375cee9645SThomas Gleixner 	int i;
15385cee9645SThomas Gleixner 
15395cee9645SThomas Gleixner 	BUG_ON(cpu_online(scpu));
15405cee9645SThomas Gleixner 	tick_cancel_sched_timer(scpu);
15415cee9645SThomas Gleixner 
15425cee9645SThomas Gleixner 	local_irq_disable();
15435cee9645SThomas Gleixner 	old_base = &per_cpu(hrtimer_bases, scpu);
1544dc5df73bSChristoph Lameter 	new_base = this_cpu_ptr(&hrtimer_bases);
15455cee9645SThomas Gleixner 	/*
15465cee9645SThomas Gleixner 	 * The caller is globally serialized and nobody else
15475cee9645SThomas Gleixner 	 * takes two locks at once, deadlock is not possible.
15485cee9645SThomas Gleixner 	 */
15495cee9645SThomas Gleixner 	raw_spin_lock(&new_base->lock);
15505cee9645SThomas Gleixner 	raw_spin_lock_nested(&old_base->lock, SINGLE_DEPTH_NESTING);
15515cee9645SThomas Gleixner 
15525cee9645SThomas Gleixner 	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
15535cee9645SThomas Gleixner 		migrate_hrtimer_list(&old_base->clock_base[i],
15545cee9645SThomas Gleixner 				     &new_base->clock_base[i]);
15555cee9645SThomas Gleixner 	}
15565cee9645SThomas Gleixner 
15575cee9645SThomas Gleixner 	raw_spin_unlock(&old_base->lock);
15585cee9645SThomas Gleixner 	raw_spin_unlock(&new_base->lock);
15595cee9645SThomas Gleixner 
15605cee9645SThomas Gleixner 	/* Check, if we got expired work to do */
15615cee9645SThomas Gleixner 	__hrtimer_peek_ahead_timers();
15625cee9645SThomas Gleixner 	local_irq_enable();
15635cee9645SThomas Gleixner }
15645cee9645SThomas Gleixner 
15655cee9645SThomas Gleixner #endif /* CONFIG_HOTPLUG_CPU */
15665cee9645SThomas Gleixner 
15675cee9645SThomas Gleixner static int hrtimer_cpu_notify(struct notifier_block *self,
15685cee9645SThomas Gleixner 					unsigned long action, void *hcpu)
15695cee9645SThomas Gleixner {
15705cee9645SThomas Gleixner 	int scpu = (long)hcpu;
15715cee9645SThomas Gleixner 
15725cee9645SThomas Gleixner 	switch (action) {
15735cee9645SThomas Gleixner 
15745cee9645SThomas Gleixner 	case CPU_UP_PREPARE:
15755cee9645SThomas Gleixner 	case CPU_UP_PREPARE_FROZEN:
15765cee9645SThomas Gleixner 		init_hrtimers_cpu(scpu);
15775cee9645SThomas Gleixner 		break;
15785cee9645SThomas Gleixner 
15795cee9645SThomas Gleixner #ifdef CONFIG_HOTPLUG_CPU
15805cee9645SThomas Gleixner 	case CPU_DEAD:
15815cee9645SThomas Gleixner 	case CPU_DEAD_FROZEN:
15825cee9645SThomas Gleixner 		migrate_hrtimers(scpu);
15835cee9645SThomas Gleixner 		break;
15845cee9645SThomas Gleixner #endif
15855cee9645SThomas Gleixner 
15865cee9645SThomas Gleixner 	default:
15875cee9645SThomas Gleixner 		break;
15885cee9645SThomas Gleixner 	}
15895cee9645SThomas Gleixner 
15905cee9645SThomas Gleixner 	return NOTIFY_OK;
15915cee9645SThomas Gleixner }
15925cee9645SThomas Gleixner 
15935cee9645SThomas Gleixner static struct notifier_block hrtimers_nb = {
15945cee9645SThomas Gleixner 	.notifier_call = hrtimer_cpu_notify,
15955cee9645SThomas Gleixner };
15965cee9645SThomas Gleixner 
15975cee9645SThomas Gleixner void __init hrtimers_init(void)
15985cee9645SThomas Gleixner {
15995cee9645SThomas Gleixner 	hrtimer_cpu_notify(&hrtimers_nb, (unsigned long)CPU_UP_PREPARE,
16005cee9645SThomas Gleixner 			  (void *)(long)smp_processor_id());
16015cee9645SThomas Gleixner 	register_cpu_notifier(&hrtimers_nb);
16025cee9645SThomas Gleixner }
16035cee9645SThomas Gleixner 
16045cee9645SThomas Gleixner /**
16055cee9645SThomas Gleixner  * schedule_hrtimeout_range_clock - sleep until timeout
16065cee9645SThomas Gleixner  * @expires:	timeout value (ktime_t)
16075cee9645SThomas Gleixner  * @delta:	slack in expires timeout (ktime_t)
16085cee9645SThomas Gleixner  * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
16095cee9645SThomas Gleixner  * @clock:	timer clock, CLOCK_MONOTONIC or CLOCK_REALTIME
16105cee9645SThomas Gleixner  */
16115cee9645SThomas Gleixner int __sched
16125cee9645SThomas Gleixner schedule_hrtimeout_range_clock(ktime_t *expires, unsigned long delta,
16135cee9645SThomas Gleixner 			       const enum hrtimer_mode mode, int clock)
16145cee9645SThomas Gleixner {
16155cee9645SThomas Gleixner 	struct hrtimer_sleeper t;
16165cee9645SThomas Gleixner 
16175cee9645SThomas Gleixner 	/*
16185cee9645SThomas Gleixner 	 * Optimize when a zero timeout value is given. It does not
16195cee9645SThomas Gleixner 	 * matter whether this is an absolute or a relative time.
16205cee9645SThomas Gleixner 	 */
16215cee9645SThomas Gleixner 	if (expires && !expires->tv64) {
16225cee9645SThomas Gleixner 		__set_current_state(TASK_RUNNING);
16235cee9645SThomas Gleixner 		return 0;
16245cee9645SThomas Gleixner 	}
16255cee9645SThomas Gleixner 
16265cee9645SThomas Gleixner 	/*
16275cee9645SThomas Gleixner 	 * A NULL parameter means "infinite"
16285cee9645SThomas Gleixner 	 */
16295cee9645SThomas Gleixner 	if (!expires) {
16305cee9645SThomas Gleixner 		schedule();
16315cee9645SThomas Gleixner 		return -EINTR;
16325cee9645SThomas Gleixner 	}
16335cee9645SThomas Gleixner 
16345cee9645SThomas Gleixner 	hrtimer_init_on_stack(&t.timer, clock, mode);
16355cee9645SThomas Gleixner 	hrtimer_set_expires_range_ns(&t.timer, *expires, delta);
16365cee9645SThomas Gleixner 
16375cee9645SThomas Gleixner 	hrtimer_init_sleeper(&t, current);
16385cee9645SThomas Gleixner 
16395cee9645SThomas Gleixner 	hrtimer_start_expires(&t.timer, mode);
16405cee9645SThomas Gleixner 
16415cee9645SThomas Gleixner 	if (likely(t.task))
16425cee9645SThomas Gleixner 		schedule();
16435cee9645SThomas Gleixner 
16445cee9645SThomas Gleixner 	hrtimer_cancel(&t.timer);
16455cee9645SThomas Gleixner 	destroy_hrtimer_on_stack(&t.timer);
16465cee9645SThomas Gleixner 
16475cee9645SThomas Gleixner 	__set_current_state(TASK_RUNNING);
16485cee9645SThomas Gleixner 
16495cee9645SThomas Gleixner 	return !t.task ? 0 : -EINTR;
16505cee9645SThomas Gleixner }
16515cee9645SThomas Gleixner 
16525cee9645SThomas Gleixner /**
16535cee9645SThomas Gleixner  * schedule_hrtimeout_range - sleep until timeout
16545cee9645SThomas Gleixner  * @expires:	timeout value (ktime_t)
16555cee9645SThomas Gleixner  * @delta:	slack in expires timeout (ktime_t)
16565cee9645SThomas Gleixner  * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
16575cee9645SThomas Gleixner  *
16585cee9645SThomas Gleixner  * Make the current task sleep until the given expiry time has
16595cee9645SThomas Gleixner  * elapsed. The routine will return immediately unless
16605cee9645SThomas Gleixner  * the current task state has been set (see set_current_state()).
16615cee9645SThomas Gleixner  *
16625cee9645SThomas Gleixner  * The @delta argument gives the kernel the freedom to schedule the
16635cee9645SThomas Gleixner  * actual wakeup to a time that is both power and performance friendly.
16645cee9645SThomas Gleixner  * The kernel give the normal best effort behavior for "@expires+@delta",
16655cee9645SThomas Gleixner  * but may decide to fire the timer earlier, but no earlier than @expires.
16665cee9645SThomas Gleixner  *
16675cee9645SThomas Gleixner  * You can set the task state as follows -
16685cee9645SThomas Gleixner  *
16695cee9645SThomas Gleixner  * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
16705cee9645SThomas Gleixner  * pass before the routine returns.
16715cee9645SThomas Gleixner  *
16725cee9645SThomas Gleixner  * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
16735cee9645SThomas Gleixner  * delivered to the current task.
16745cee9645SThomas Gleixner  *
16755cee9645SThomas Gleixner  * The current task state is guaranteed to be TASK_RUNNING when this
16765cee9645SThomas Gleixner  * routine returns.
16775cee9645SThomas Gleixner  *
16785cee9645SThomas Gleixner  * Returns 0 when the timer has expired otherwise -EINTR
16795cee9645SThomas Gleixner  */
16805cee9645SThomas Gleixner int __sched schedule_hrtimeout_range(ktime_t *expires, unsigned long delta,
16815cee9645SThomas Gleixner 				     const enum hrtimer_mode mode)
16825cee9645SThomas Gleixner {
16835cee9645SThomas Gleixner 	return schedule_hrtimeout_range_clock(expires, delta, mode,
16845cee9645SThomas Gleixner 					      CLOCK_MONOTONIC);
16855cee9645SThomas Gleixner }
16865cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(schedule_hrtimeout_range);
16875cee9645SThomas Gleixner 
16885cee9645SThomas Gleixner /**
16895cee9645SThomas Gleixner  * schedule_hrtimeout - sleep until timeout
16905cee9645SThomas Gleixner  * @expires:	timeout value (ktime_t)
16915cee9645SThomas Gleixner  * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
16925cee9645SThomas Gleixner  *
16935cee9645SThomas Gleixner  * Make the current task sleep until the given expiry time has
16945cee9645SThomas Gleixner  * elapsed. The routine will return immediately unless
16955cee9645SThomas Gleixner  * the current task state has been set (see set_current_state()).
16965cee9645SThomas Gleixner  *
16975cee9645SThomas Gleixner  * You can set the task state as follows -
16985cee9645SThomas Gleixner  *
16995cee9645SThomas Gleixner  * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
17005cee9645SThomas Gleixner  * pass before the routine returns.
17015cee9645SThomas Gleixner  *
17025cee9645SThomas Gleixner  * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
17035cee9645SThomas Gleixner  * delivered to the current task.
17045cee9645SThomas Gleixner  *
17055cee9645SThomas Gleixner  * The current task state is guaranteed to be TASK_RUNNING when this
17065cee9645SThomas Gleixner  * routine returns.
17075cee9645SThomas Gleixner  *
17085cee9645SThomas Gleixner  * Returns 0 when the timer has expired otherwise -EINTR
17095cee9645SThomas Gleixner  */
17105cee9645SThomas Gleixner int __sched schedule_hrtimeout(ktime_t *expires,
17115cee9645SThomas Gleixner 			       const enum hrtimer_mode mode)
17125cee9645SThomas Gleixner {
17135cee9645SThomas Gleixner 	return schedule_hrtimeout_range(expires, 0, mode);
17145cee9645SThomas Gleixner }
17155cee9645SThomas Gleixner EXPORT_SYMBOL_GPL(schedule_hrtimeout);
1716