Blame view

kernel/hrtimer.c 46.4 KB
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1
2
3
  /*
   *  linux/kernel/hrtimer.c
   *
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
4
   *  Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
79bf2bb33   Thomas Gleixner   [PATCH] tick-mana...
5
   *  Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
6
   *  Copyright(C) 2006-2007  Timesys Corp., Thomas Gleixner
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
   *
   *  High-resolution kernel timers
   *
   *  In contrast to the low-resolution timeout API implemented in
   *  kernel/timer.c, hrtimers provide finer resolution and accuracy
   *  depending on system configuration and capabilities.
   *
   *  These timers are currently used for:
   *   - itimers
   *   - POSIX timers
   *   - nanosleep
   *   - precise in-kernel timing
   *
   *  Started by: Thomas Gleixner and Ingo Molnar
   *
   *  Credits:
   *	based on kernel/timer.c
   *
66188fae3   Thomas Gleixner   [PATCH] hrtimers:...
25
26
27
28
29
30
   *	Help, testing, suggestions, bugfixes, improvements were
   *	provided by:
   *
   *	George Anzinger, Andrew Morton, Steven Rostedt, Roman Zippel
   *	et. al.
   *
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
31
32
33
34
   *  For licencing details see kernel-base/COPYING
   */
  
  #include <linux/cpu.h>
9984de1a5   Paul Gortmaker   kernel: Map most ...
35
  #include <linux/export.h>
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
36
37
38
39
  #include <linux/percpu.h>
  #include <linux/hrtimer.h>
  #include <linux/notifier.h>
  #include <linux/syscalls.h>
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
40
  #include <linux/kallsyms.h>
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
41
  #include <linux/interrupt.h>
79bf2bb33   Thomas Gleixner   [PATCH] tick-mana...
42
  #include <linux/tick.h>
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
43
44
  #include <linux/seq_file.h>
  #include <linux/err.h>
237fc6e7a   Thomas Gleixner   add hrtimer speci...
45
  #include <linux/debugobjects.h>
eea08f32a   Arun R Bharadwaj   timers: Logic to ...
46
47
  #include <linux/sched.h>
  #include <linux/timer.h>
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
48
49
  
  #include <asm/uaccess.h>
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
50
  #include <trace/events/timer.h>
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
51
52
  /*
   * The timer bases:
7978672c4   George Anzinger   [PATCH] hrtimers:...
53
   *
e06383db9   John Stultz   hrtimers: extend ...
54
55
56
57
   * There are more clockids then hrtimer bases. Thus, we index
   * into the timer bases by the hrtimer_base_type enum. When trying
   * to reach a base using a clockid, hrtimer_clockid_to_base()
   * is used to convert from clockid to the proper hrtimer_base_type.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
58
   */
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
59
  DEFINE_PER_CPU(struct hrtimer_cpu_base, hrtimer_bases) =
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
60
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
61
62
  
  	.clock_base =
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
63
  	{
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
64
  		{
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
65
66
  			.index = HRTIMER_BASE_MONOTONIC,
  			.clockid = CLOCK_MONOTONIC,
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
67
  			.get_time = &ktime_get,
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
68
  			.resolution = KTIME_LOW_RES,
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
69
  		},
70a08cca1   John Stultz   timers: Add CLOCK...
70
  		{
68fa61c02   Thomas Gleixner   hrtimers: Reorder...
71
72
73
74
75
76
  			.index = HRTIMER_BASE_REALTIME,
  			.clockid = CLOCK_REALTIME,
  			.get_time = &ktime_get_real,
  			.resolution = KTIME_LOW_RES,
  		},
  		{
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
77
78
  			.index = HRTIMER_BASE_BOOTTIME,
  			.clockid = CLOCK_BOOTTIME,
70a08cca1   John Stultz   timers: Add CLOCK...
79
80
81
  			.get_time = &ktime_get_boottime,
  			.resolution = KTIME_LOW_RES,
  		},
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
82
  	}
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
83
  };
942c3c5c3   Mike Frysinger   hrtimer: Make loo...
84
  static const int hrtimer_clock_to_base_table[MAX_CLOCKS] = {
ce31332d3   Thomas Gleixner   hrtimer: Initiali...
85
86
87
88
  	[CLOCK_REALTIME]	= HRTIMER_BASE_REALTIME,
  	[CLOCK_MONOTONIC]	= HRTIMER_BASE_MONOTONIC,
  	[CLOCK_BOOTTIME]	= HRTIMER_BASE_BOOTTIME,
  };
e06383db9   John Stultz   hrtimers: extend ...
89
90
91
92
93
  
  static inline int hrtimer_clockid_to_base(clockid_t clock_id)
  {
  	return hrtimer_clock_to_base_table[clock_id];
  }
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
94
  /*
92127c7a4   Thomas Gleixner   [PATCH] hrtimers:...
95
96
97
   * Get the coarse grained time at the softirq based on xtime and
   * wall_to_monotonic.
   */
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
98
  static void hrtimer_get_softirq_time(struct hrtimer_cpu_base *base)
92127c7a4   Thomas Gleixner   [PATCH] hrtimers:...
99
  {
70a08cca1   John Stultz   timers: Add CLOCK...
100
  	ktime_t xtim, mono, boot;
314ac3715   John Stultz   time: Extend get_...
101
  	struct timespec xts, tom, slp;
92127c7a4   Thomas Gleixner   [PATCH] hrtimers:...
102

314ac3715   John Stultz   time: Extend get_...
103
  	get_xtime_and_monotonic_and_sleep_offset(&xts, &tom, &slp);
92127c7a4   Thomas Gleixner   [PATCH] hrtimers:...
104

f4304ab21   John Stultz   [PATCH] HZ free ntp
105
  	xtim = timespec_to_ktime(xts);
70a08cca1   John Stultz   timers: Add CLOCK...
106
107
  	mono = ktime_add(xtim, timespec_to_ktime(tom));
  	boot = ktime_add(mono, timespec_to_ktime(slp));
e06383db9   John Stultz   hrtimers: extend ...
108
  	base->clock_base[HRTIMER_BASE_REALTIME].softirq_time = xtim;
70a08cca1   John Stultz   timers: Add CLOCK...
109
110
  	base->clock_base[HRTIMER_BASE_MONOTONIC].softirq_time = mono;
  	base->clock_base[HRTIMER_BASE_BOOTTIME].softirq_time = boot;
92127c7a4   Thomas Gleixner   [PATCH] hrtimers:...
111
112
113
  }
  
  /*
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
114
115
116
117
   * Functions and macros which are different for UP/SMP systems are kept in a
   * single place
   */
  #ifdef CONFIG_SMP
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
118
119
120
121
122
123
124
125
126
127
128
129
  /*
   * We are using hashed locking: holding per_cpu(hrtimer_bases)[n].lock
   * means that all timers which are tied to this base via timer->base are
   * locked, and the base itself is locked too.
   *
   * So __run_timers/migrate_timers can safely modify all timers which could
   * be found on the lists/queues.
   *
   * When the timer's base is locked, and the timer removed from list, it is
   * possible to set timer->base = NULL and drop the lock: the timer remains
   * locked.
   */
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
130
131
132
  static
  struct hrtimer_clock_base *lock_hrtimer_base(const struct hrtimer *timer,
  					     unsigned long *flags)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
133
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
134
  	struct hrtimer_clock_base *base;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
135
136
137
138
  
  	for (;;) {
  		base = timer->base;
  		if (likely(base != NULL)) {
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
139
  			raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
140
141
142
  			if (likely(base == timer->base))
  				return base;
  			/* The timer has migrated to another CPU: */
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
143
  			raw_spin_unlock_irqrestore(&base->cpu_base->lock, *flags);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
144
145
146
147
  		}
  		cpu_relax();
  	}
  }
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
148
149
150
151
152
153
154
  
  /*
   * Get the preferred target CPU for NOHZ
   */
  static int hrtimer_get_target(int this_cpu, int pinned)
  {
  #ifdef CONFIG_NO_HZ
83cd4fe27   Venkatesh Pallipadi   sched: Change noh...
155
156
  	if (!pinned && get_sysctl_timer_migration() && idle_cpu(this_cpu))
  		return get_nohz_timer_target();
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
  #endif
  	return this_cpu;
  }
  
  /*
   * With HIGHRES=y we do not migrate the timer when it is expiring
   * before the next event on the target cpu because we cannot reprogram
   * the target cpu hardware and we would cause it to fire late.
   *
   * Called with cpu_base->lock of target cpu held.
   */
  static int
  hrtimer_check_target(struct hrtimer *timer, struct hrtimer_clock_base *new_base)
  {
  #ifdef CONFIG_HIGH_RES_TIMERS
  	ktime_t expires;
  
  	if (!new_base->cpu_base->hres_active)
  		return 0;
  
  	expires = ktime_sub(hrtimer_get_expires(timer), new_base->offset);
  	return expires.tv64 <= new_base->cpu_base->expires_next.tv64;
  #else
  	return 0;
  #endif
  }
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
183
184
185
  /*
   * Switch the timer base to the current CPU when possible.
   */
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
186
  static inline struct hrtimer_clock_base *
597d02757   Arun R Bharadwaj   timers: Framework...
187
188
  switch_hrtimer_base(struct hrtimer *timer, struct hrtimer_clock_base *base,
  		    int pinned)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
189
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
190
191
  	struct hrtimer_clock_base *new_base;
  	struct hrtimer_cpu_base *new_cpu_base;
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
192
193
  	int this_cpu = smp_processor_id();
  	int cpu = hrtimer_get_target(this_cpu, pinned);
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
194
  	int basenum = base->index;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
195

eea08f32a   Arun R Bharadwaj   timers: Logic to ...
196
197
  again:
  	new_cpu_base = &per_cpu(hrtimer_bases, cpu);
e06383db9   John Stultz   hrtimers: extend ...
198
  	new_base = &new_cpu_base->clock_base[basenum];
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
199
200
201
  
  	if (base != new_base) {
  		/*
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
202
  		 * We are trying to move timer to new_base.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
203
204
205
206
207
208
209
  		 * However we can't change timer's base while it is running,
  		 * so we keep it on the same CPU. No hassle vs. reprogramming
  		 * the event source in the high resolution case. The softirq
  		 * code will take care of this when the timer function has
  		 * completed. There is no conflict as we hold the lock until
  		 * the timer is enqueued.
  		 */
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
210
  		if (unlikely(hrtimer_callback_running(timer)))
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
211
212
213
214
  			return base;
  
  		/* See the comment in lock_timer_base() */
  		timer->base = NULL;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
215
216
  		raw_spin_unlock(&base->cpu_base->lock);
  		raw_spin_lock(&new_base->cpu_base->lock);
eea08f32a   Arun R Bharadwaj   timers: Logic to ...
217

6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
218
219
  		if (cpu != this_cpu && hrtimer_check_target(timer, new_base)) {
  			cpu = this_cpu;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
220
221
  			raw_spin_unlock(&new_base->cpu_base->lock);
  			raw_spin_lock(&base->cpu_base->lock);
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
222
223
  			timer->base = base;
  			goto again;
eea08f32a   Arun R Bharadwaj   timers: Logic to ...
224
  		}
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
225
226
227
228
229
230
  		timer->base = new_base;
  	}
  	return new_base;
  }
  
  #else /* CONFIG_SMP */
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
231
  static inline struct hrtimer_clock_base *
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
232
233
  lock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
234
  	struct hrtimer_clock_base *base = timer->base;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
235

ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
236
  	raw_spin_lock_irqsave(&base->cpu_base->lock, *flags);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
237
238
239
  
  	return base;
  }
eea08f32a   Arun R Bharadwaj   timers: Logic to ...
240
  # define switch_hrtimer_base(t, b, p)	(b)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
241
242
243
244
245
246
247
248
249
250
251
  
  #endif	/* !CONFIG_SMP */
  
  /*
   * Functions for the union type storage format of ktime_t which are
   * too large for inlining:
   */
  #if BITS_PER_LONG < 64
  # ifndef CONFIG_KTIME_SCALAR
  /**
   * ktime_add_ns - Add a scalar nanoseconds value to a ktime_t variable
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
   * @kt:		addend
   * @nsec:	the scalar nsec value to add
   *
   * Returns the sum of kt and nsec in ktime_t format
   */
  ktime_t ktime_add_ns(const ktime_t kt, u64 nsec)
  {
  	ktime_t tmp;
  
  	if (likely(nsec < NSEC_PER_SEC)) {
  		tmp.tv64 = nsec;
  	} else {
  		unsigned long rem = do_div(nsec, NSEC_PER_SEC);
  
  		tmp = ktime_set((long)nsec, rem);
  	}
  
  	return ktime_add(kt, tmp);
  }
b8b8fd2dc   David Howells   [NET]: Fix networ...
271
272
  
  EXPORT_SYMBOL_GPL(ktime_add_ns);
a272378d1   Arnaldo Carvalho de Melo   [KTIME]: Introduc...
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
  
  /**
   * ktime_sub_ns - Subtract a scalar nanoseconds value from a ktime_t variable
   * @kt:		minuend
   * @nsec:	the scalar nsec value to subtract
   *
   * Returns the subtraction of @nsec from @kt in ktime_t format
   */
  ktime_t ktime_sub_ns(const ktime_t kt, u64 nsec)
  {
  	ktime_t tmp;
  
  	if (likely(nsec < NSEC_PER_SEC)) {
  		tmp.tv64 = nsec;
  	} else {
  		unsigned long rem = do_div(nsec, NSEC_PER_SEC);
  
  		tmp = ktime_set((long)nsec, rem);
  	}
  
  	return ktime_sub(kt, tmp);
  }
  
  EXPORT_SYMBOL_GPL(ktime_sub_ns);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
297
298
299
300
301
  # endif /* !CONFIG_KTIME_SCALAR */
  
  /*
   * Divide a ktime value by a nanosecond value
   */
4d672e7ac   Davide Libenzi   timerfd: new time...
302
  u64 ktime_divns(const ktime_t kt, s64 div)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
303
  {
900cfa461   Carlos R. Mafra   hrtimer: Remove u...
304
  	u64 dclc;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
305
  	int sft = 0;
900cfa461   Carlos R. Mafra   hrtimer: Remove u...
306
  	dclc = ktime_to_ns(kt);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
307
308
309
310
311
312
313
  	/* Make sure the divisor is less than 2^32: */
  	while (div >> 32) {
  		sft++;
  		div >>= 1;
  	}
  	dclc >>= sft;
  	do_div(dclc, (unsigned long) div);
4d672e7ac   Davide Libenzi   timerfd: new time...
314
  	return dclc;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
315
  }
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
316
  #endif /* BITS_PER_LONG >= 64 */
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
317
  /*
5a7780e72   Thomas Gleixner   hrtimer: check re...
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
   * Add two ktime values and do a safety check for overflow:
   */
  ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs)
  {
  	ktime_t res = ktime_add(lhs, rhs);
  
  	/*
  	 * We use KTIME_SEC_MAX here, the maximum timeout which we can
  	 * return to user space in a timespec:
  	 */
  	if (res.tv64 < 0 || res.tv64 < lhs.tv64 || res.tv64 < rhs.tv64)
  		res = ktime_set(KTIME_SEC_MAX, 0);
  
  	return res;
  }
8daa21e61   Artem Bityutskiy   hrtimer: export k...
333
  EXPORT_SYMBOL_GPL(ktime_add_safe);
237fc6e7a   Thomas Gleixner   add hrtimer speci...
334
335
336
  #ifdef CONFIG_DEBUG_OBJECTS_TIMERS
  
  static struct debug_obj_descr hrtimer_debug_descr;
997772884   Stanislaw Gruszka   debugobjects: Add...
337
338
339
340
  static void *hrtimer_debug_hint(void *addr)
  {
  	return ((struct hrtimer *) addr)->function;
  }
237fc6e7a   Thomas Gleixner   add hrtimer speci...
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
  /*
   * fixup_init is called when:
   * - an active object is initialized
   */
  static int hrtimer_fixup_init(void *addr, enum debug_obj_state state)
  {
  	struct hrtimer *timer = addr;
  
  	switch (state) {
  	case ODEBUG_STATE_ACTIVE:
  		hrtimer_cancel(timer);
  		debug_object_init(timer, &hrtimer_debug_descr);
  		return 1;
  	default:
  		return 0;
  	}
  }
  
  /*
   * fixup_activate is called when:
   * - an active object is activated
   * - an unknown object is activated (might be a statically initialized object)
   */
  static int hrtimer_fixup_activate(void *addr, enum debug_obj_state state)
  {
  	switch (state) {
  
  	case ODEBUG_STATE_NOTAVAILABLE:
  		WARN_ON_ONCE(1);
  		return 0;
  
  	case ODEBUG_STATE_ACTIVE:
  		WARN_ON(1);
  
  	default:
  		return 0;
  	}
  }
  
  /*
   * fixup_free is called when:
   * - an active object is freed
   */
  static int hrtimer_fixup_free(void *addr, enum debug_obj_state state)
  {
  	struct hrtimer *timer = addr;
  
  	switch (state) {
  	case ODEBUG_STATE_ACTIVE:
  		hrtimer_cancel(timer);
  		debug_object_free(timer, &hrtimer_debug_descr);
  		return 1;
  	default:
  		return 0;
  	}
  }
  
  static struct debug_obj_descr hrtimer_debug_descr = {
  	.name		= "hrtimer",
997772884   Stanislaw Gruszka   debugobjects: Add...
400
  	.debug_hint	= hrtimer_debug_hint,
237fc6e7a   Thomas Gleixner   add hrtimer speci...
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
  	.fixup_init	= hrtimer_fixup_init,
  	.fixup_activate	= hrtimer_fixup_activate,
  	.fixup_free	= hrtimer_fixup_free,
  };
  
  static inline void debug_hrtimer_init(struct hrtimer *timer)
  {
  	debug_object_init(timer, &hrtimer_debug_descr);
  }
  
  static inline void debug_hrtimer_activate(struct hrtimer *timer)
  {
  	debug_object_activate(timer, &hrtimer_debug_descr);
  }
  
  static inline void debug_hrtimer_deactivate(struct hrtimer *timer)
  {
  	debug_object_deactivate(timer, &hrtimer_debug_descr);
  }
  
  static inline void debug_hrtimer_free(struct hrtimer *timer)
  {
  	debug_object_free(timer, &hrtimer_debug_descr);
  }
  
  static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  			   enum hrtimer_mode mode);
  
  void hrtimer_init_on_stack(struct hrtimer *timer, clockid_t clock_id,
  			   enum hrtimer_mode mode)
  {
  	debug_object_init_on_stack(timer, &hrtimer_debug_descr);
  	__hrtimer_init(timer, clock_id, mode);
  }
2bc481cf4   Stephen Hemminger   pktgen: spin usin...
435
  EXPORT_SYMBOL_GPL(hrtimer_init_on_stack);
237fc6e7a   Thomas Gleixner   add hrtimer speci...
436
437
438
439
440
441
442
443
444
445
446
  
  void destroy_hrtimer_on_stack(struct hrtimer *timer)
  {
  	debug_object_free(timer, &hrtimer_debug_descr);
  }
  
  #else
  static inline void debug_hrtimer_init(struct hrtimer *timer) { }
  static inline void debug_hrtimer_activate(struct hrtimer *timer) { }
  static inline void debug_hrtimer_deactivate(struct hrtimer *timer) { }
  #endif
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
  static inline void
  debug_init(struct hrtimer *timer, clockid_t clockid,
  	   enum hrtimer_mode mode)
  {
  	debug_hrtimer_init(timer);
  	trace_hrtimer_init(timer, clockid, mode);
  }
  
  static inline void debug_activate(struct hrtimer *timer)
  {
  	debug_hrtimer_activate(timer);
  	trace_hrtimer_start(timer);
  }
  
  static inline void debug_deactivate(struct hrtimer *timer)
  {
  	debug_hrtimer_deactivate(timer);
  	trace_hrtimer_cancel(timer);
  }
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
  /* High resolution timer related functions */
  #ifdef CONFIG_HIGH_RES_TIMERS
  
  /*
   * High resolution timer enabled ?
   */
  static int hrtimer_hres_enabled __read_mostly  = 1;
  
  /*
   * Enable / Disable high resolution mode
   */
  static int __init setup_hrtimer_hres(char *str)
  {
  	if (!strcmp(str, "off"))
  		hrtimer_hres_enabled = 0;
  	else if (!strcmp(str, "on"))
  		hrtimer_hres_enabled = 1;
  	else
  		return 0;
  	return 1;
  }
  
  __setup("highres=", setup_hrtimer_hres);
  
  /*
   * hrtimer_high_res_enabled - query, if the highres mode is enabled
   */
  static inline int hrtimer_is_hres_enabled(void)
  {
  	return hrtimer_hres_enabled;
  }
  
  /*
   * Is the high resolution mode active ?
   */
  static inline int hrtimer_hres_active(void)
  {
909ea9646   Christoph Lameter   core: Replace __g...
503
  	return __this_cpu_read(hrtimer_bases.hres_active);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
504
505
506
507
508
509
510
  }
  
  /*
   * Reprogram the event source with checking both queues for the
   * next event
   * Called with interrupts disabled and base->lock held
   */
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
511
512
  static void
  hrtimer_force_reprogram(struct hrtimer_cpu_base *cpu_base, int skip_equal)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
513
514
515
  {
  	int i;
  	struct hrtimer_clock_base *base = cpu_base->clock_base;
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
516
  	ktime_t expires, expires_next;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
517

7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
518
  	expires_next.tv64 = KTIME_MAX;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
519
520
521
  
  	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++, base++) {
  		struct hrtimer *timer;
998adc3dd   John Stultz   hrtimers: Convert...
522
  		struct timerqueue_node *next;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
523

998adc3dd   John Stultz   hrtimers: Convert...
524
525
  		next = timerqueue_getnext(&base->active);
  		if (!next)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
526
  			continue;
998adc3dd   John Stultz   hrtimers: Convert...
527
  		timer = container_of(next, struct hrtimer, node);
cc584b213   Arjan van de Ven   hrtimer: convert ...
528
  		expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
b0a9b5111   Thomas Gleixner   hrtimer: prevent ...
529
530
531
532
533
534
535
  		/*
  		 * clock_was_set() has changed base->offset so the
  		 * result might be negative. Fix it up to prevent a
  		 * false positive in clockevents_program_event()
  		 */
  		if (expires.tv64 < 0)
  			expires.tv64 = 0;
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
536
537
  		if (expires.tv64 < expires_next.tv64)
  			expires_next = expires;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
538
  	}
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
539
540
541
542
  	if (skip_equal && expires_next.tv64 == cpu_base->expires_next.tv64)
  		return;
  
  	cpu_base->expires_next.tv64 = expires_next.tv64;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
  	if (cpu_base->expires_next.tv64 != KTIME_MAX)
  		tick_program_event(cpu_base->expires_next, 1);
  }
  
  /*
   * Shared reprogramming for clock_realtime and clock_monotonic
   *
   * When a timer is enqueued and expires earlier than the already enqueued
   * timers, we have to check, whether it expires earlier than the timer for
   * which the clock event device was armed.
   *
   * Called with interrupts disabled and base->cpu_base.lock held
   */
  static int hrtimer_reprogram(struct hrtimer *timer,
  			     struct hrtimer_clock_base *base)
  {
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
559
  	struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
cc584b213   Arjan van de Ven   hrtimer: convert ...
560
  	ktime_t expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
561
  	int res;
cc584b213   Arjan van de Ven   hrtimer: convert ...
562
  	WARN_ON_ONCE(hrtimer_get_expires_tv64(timer) < 0);
63070a79b   Thomas Gleixner   hrtimer: catch ex...
563

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
564
565
566
  	/*
  	 * When the callback is running, we do not reprogram the clock event
  	 * device. The timer callback is either running on a different CPU or
3a4fa0a25   Robert P. J. Day   Fix misspellings ...
567
  	 * the callback is executed in the hrtimer_interrupt context. The
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
568
569
570
571
572
  	 * reprogramming is handled either by the softirq, which called the
  	 * callback or at the end of the hrtimer_interrupt.
  	 */
  	if (hrtimer_callback_running(timer))
  		return 0;
63070a79b   Thomas Gleixner   hrtimer: catch ex...
573
574
575
576
577
578
579
580
  	/*
  	 * CLOCK_REALTIME timer might be requested with an absolute
  	 * expiry time which is less than base->offset. Nothing wrong
  	 * about that, just avoid to call into the tick code, which
  	 * has now objections against negative expiry values.
  	 */
  	if (expires.tv64 < 0)
  		return -ETIME;
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
581
582
583
584
585
586
587
588
589
590
  	if (expires.tv64 >= cpu_base->expires_next.tv64)
  		return 0;
  
  	/*
  	 * If a hang was detected in the last timer interrupt then we
  	 * do not schedule a timer which is earlier than the expiry
  	 * which we enforced in the hang detection. We want the system
  	 * to make progress.
  	 */
  	if (cpu_base->hang_detected)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
591
592
593
594
595
596
597
  		return 0;
  
  	/*
  	 * Clockevents returns -ETIME, when the event was in the past.
  	 */
  	res = tick_program_event(expires, 0);
  	if (!IS_ERR_VALUE(res))
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
598
  		cpu_base->expires_next = expires;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
599
600
  	return res;
  }
995f054f2   Ingo Molnar   [PATCH] high-res ...
601
  /*
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
602
603
604
605
606
607
   * Initialize the high resolution related parts of cpu_base
   */
  static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base)
  {
  	base->expires_next.tv64 = KTIME_MAX;
  	base->hres_active = 0;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
608
609
610
  }
  
  /*
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
611
612
613
614
615
616
   * When High resolution timers are active, try to reprogram. Note, that in case
   * the state has HRTIMER_STATE_CALLBACK set, no reprogramming and no expiry
   * check happens. The timer gets enqueued into the rbtree. The reprogramming
   * and expiry check is done in the hrtimer_interrupt or in the softirq.
   */
  static inline int hrtimer_enqueue_reprogram(struct hrtimer *timer,
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
617
618
  					    struct hrtimer_clock_base *base,
  					    int wakeup)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
619
620
  {
  	if (base->cpu_base->hres_active && hrtimer_reprogram(timer, base)) {
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
621
  		if (wakeup) {
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
622
  			raw_spin_unlock(&base->cpu_base->lock);
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
623
  			raise_softirq_irqoff(HRTIMER_SOFTIRQ);
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
624
  			raw_spin_lock(&base->cpu_base->lock);
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
625
626
  		} else
  			__raise_softirq_irqoff(HRTIMER_SOFTIRQ);
ca109491f   Peter Zijlstra   hrtimer: removing...
627
  		return 1;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
628
  	}
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
629

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
630
631
  	return 0;
  }
9ec269075   Thomas Gleixner   timerfd: Manage c...
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
  /*
   * Retrigger next event is called after clock was set
   *
   * Called with interrupts disabled via on_each_cpu()
   */
  static void retrigger_next_event(void *arg)
  {
  	struct hrtimer_cpu_base *base = &__get_cpu_var(hrtimer_bases);
  	struct timespec realtime_offset, xtim, wtm, sleep;
  
  	if (!hrtimer_hres_active())
  		return;
  
  	/* Optimized out for !HIGH_RES */
  	get_xtime_and_monotonic_and_sleep_offset(&xtim, &wtm, &sleep);
  	set_normalized_timespec(&realtime_offset, -wtm.tv_sec, -wtm.tv_nsec);
  
  	/* Adjust CLOCK_REALTIME offset */
  	raw_spin_lock(&base->lock);
  	base->clock_base[HRTIMER_BASE_REALTIME].offset =
  		timespec_to_ktime(realtime_offset);
  	base->clock_base[HRTIMER_BASE_BOOTTIME].offset =
  		timespec_to_ktime(sleep);
  
  	hrtimer_force_reprogram(base, 0);
  	raw_spin_unlock(&base->lock);
  }
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
659

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
660
661
662
  /*
   * Switch to high resolution mode
   */
f8953856e   Thomas Gleixner   [PATCH] highres: ...
663
  static int hrtimer_switch_to_hres(void)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
664
  {
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
665
  	int i, cpu = smp_processor_id();
820de5c39   Ingo Molnar   highres: improve ...
666
  	struct hrtimer_cpu_base *base = &per_cpu(hrtimer_bases, cpu);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
667
668
669
  	unsigned long flags;
  
  	if (base->hres_active)
f8953856e   Thomas Gleixner   [PATCH] highres: ...
670
  		return 1;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
671
672
673
674
675
  
  	local_irq_save(flags);
  
  	if (tick_init_highres()) {
  		local_irq_restore(flags);
820de5c39   Ingo Molnar   highres: improve ...
676
677
678
  		printk(KERN_WARNING "Could not switch to high resolution "
  				    "mode on CPU %d
  ", cpu);
f8953856e   Thomas Gleixner   [PATCH] highres: ...
679
  		return 0;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
680
681
  	}
  	base->hres_active = 1;
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
682
683
  	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++)
  		base->clock_base[i].resolution = KTIME_HIGH_RES;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
684
685
686
687
688
689
  
  	tick_setup_sched_timer();
  
  	/* "Retrigger" the interrupt to get things going */
  	retrigger_next_event(NULL);
  	local_irq_restore(flags);
f8953856e   Thomas Gleixner   [PATCH] highres: ...
690
  	return 1;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
691
692
693
694
695
696
  }
  
  #else
  
  static inline int hrtimer_hres_active(void) { return 0; }
  static inline int hrtimer_is_hres_enabled(void) { return 0; }
f8953856e   Thomas Gleixner   [PATCH] highres: ...
697
  static inline int hrtimer_switch_to_hres(void) { return 0; }
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
698
699
  static inline void
  hrtimer_force_reprogram(struct hrtimer_cpu_base *base, int skip_equal) { }
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
700
  static inline int hrtimer_enqueue_reprogram(struct hrtimer *timer,
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
701
702
  					    struct hrtimer_clock_base *base,
  					    int wakeup)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
703
704
705
  {
  	return 0;
  }
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
706
  static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base) { }
9ec269075   Thomas Gleixner   timerfd: Manage c...
707
  static inline void retrigger_next_event(void *arg) { }
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
708
709
  
  #endif /* CONFIG_HIGH_RES_TIMERS */
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
710
  /*
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
711
712
713
714
715
716
717
718
719
720
721
722
   * Clock realtime was set
   *
   * Change the offset of the realtime clock vs. the monotonic
   * clock.
   *
   * We might have to reprogram the high resolution timer interrupt. On
   * SMP we call the architecture specific code to retrigger _all_ high
   * resolution timer interrupts. On UP we just disable interrupts and
   * call the high resolution interrupt code.
   */
  void clock_was_set(void)
  {
90ff1f30c   Thomas Gleixner   hrtimers: Fix typ...
723
  #ifdef CONFIG_HIGH_RES_TIMERS
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
724
725
  	/* Retrigger the CPU local events everywhere */
  	on_each_cpu(retrigger_next_event, NULL, 1);
9ec269075   Thomas Gleixner   timerfd: Manage c...
726
727
  #endif
  	timerfd_clock_was_set();
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
728
729
730
731
732
733
734
735
736
737
738
739
  }
  
  /*
   * During resume we might have to reprogram the high resolution timer
   * interrupt (on the local CPU):
   */
  void hrtimers_resume(void)
  {
  	WARN_ONCE(!irqs_disabled(),
  		  KERN_INFO "hrtimers_resume() called with IRQs enabled!");
  
  	retrigger_next_event(NULL);
9ec269075   Thomas Gleixner   timerfd: Manage c...
740
  	timerfd_clock_was_set();
b12a03ce4   Thomas Gleixner   hrtimers: Prepare...
741
  }
5f201907d   Heiko Carstens   hrtimer: move tim...
742
  static inline void timer_stats_hrtimer_set_start_info(struct hrtimer *timer)
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
743
  {
5f201907d   Heiko Carstens   hrtimer: move tim...
744
  #ifdef CONFIG_TIMER_STATS
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
745
746
  	if (timer->start_site)
  		return;
5f201907d   Heiko Carstens   hrtimer: move tim...
747
  	timer->start_site = __builtin_return_address(0);
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
748
749
  	memcpy(timer->start_comm, current->comm, TASK_COMM_LEN);
  	timer->start_pid = current->pid;
5f201907d   Heiko Carstens   hrtimer: move tim...
750
751
752
753
754
755
756
757
  #endif
  }
  
  static inline void timer_stats_hrtimer_clear_start_info(struct hrtimer *timer)
  {
  #ifdef CONFIG_TIMER_STATS
  	timer->start_site = NULL;
  #endif
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
758
  }
5f201907d   Heiko Carstens   hrtimer: move tim...
759
760
761
762
763
764
765
766
  
  static inline void timer_stats_account_hrtimer(struct hrtimer *timer)
  {
  #ifdef CONFIG_TIMER_STATS
  	if (likely(!timer_stats_active))
  		return;
  	timer_stats_update_stats(timer, timer->start_pid, timer->start_site,
  				 timer->function, timer->start_comm, 0);
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
767
  #endif
5f201907d   Heiko Carstens   hrtimer: move tim...
768
  }
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
769

c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
770
  /*
6506f2aa6   Uwe Kleine-König   fix comment: unlo...
771
   * Counterpart to lock_hrtimer_base above:
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
772
773
774
775
   */
  static inline
  void unlock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
  {
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
776
  	raw_spin_unlock_irqrestore(&timer->base->cpu_base->lock, *flags);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
777
778
779
780
  }
  
  /**
   * hrtimer_forward - forward the timer expiry
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
781
   * @timer:	hrtimer to forward
44f214755   Roman Zippel   [PATCH] hrtimers:...
782
   * @now:	forward past this time
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
783
784
785
   * @interval:	the interval to forward
   *
   * Forward the timer expiry so it will expire in the future.
8dca6f33f   Jonathan Corbet   [PATCH] hrtimer c...
786
   * Returns the number of overruns.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
787
   */
4d672e7ac   Davide Libenzi   timerfd: new time...
788
  u64 hrtimer_forward(struct hrtimer *timer, ktime_t now, ktime_t interval)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
789
  {
4d672e7ac   Davide Libenzi   timerfd: new time...
790
  	u64 orun = 1;
44f214755   Roman Zippel   [PATCH] hrtimers:...
791
  	ktime_t delta;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
792

cc584b213   Arjan van de Ven   hrtimer: convert ...
793
  	delta = ktime_sub(now, hrtimer_get_expires(timer));
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
794
795
796
  
  	if (delta.tv64 < 0)
  		return 0;
c9db4fa11   Thomas Gleixner   [hrtimer] Enforce...
797
798
  	if (interval.tv64 < timer->base->resolution.tv64)
  		interval.tv64 = timer->base->resolution.tv64;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
799
  	if (unlikely(delta.tv64 >= interval.tv64)) {
df869b630   Roman Zippel   [PATCH] hrtimers:...
800
  		s64 incr = ktime_to_ns(interval);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
801
802
  
  		orun = ktime_divns(delta, incr);
cc584b213   Arjan van de Ven   hrtimer: convert ...
803
804
  		hrtimer_add_expires_ns(timer, incr * orun);
  		if (hrtimer_get_expires_tv64(timer) > now.tv64)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
805
806
807
808
809
810
811
  			return orun;
  		/*
  		 * This (and the ktime_add() below) is the
  		 * correction for exact:
  		 */
  		orun++;
  	}
cc584b213   Arjan van de Ven   hrtimer: convert ...
812
  	hrtimer_add_expires(timer, interval);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
813
814
815
  
  	return orun;
  }
6bdb6b620   Stas Sergeev   export hrtimer_fo...
816
  EXPORT_SYMBOL_GPL(hrtimer_forward);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
817
818
819
820
821
822
  
  /*
   * enqueue_hrtimer - internal function to (re)start a timer
   *
   * The timer is inserted in expiry order. Insertion into the
   * red black tree is O(log(n)). Must hold the base lock.
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
823
824
   *
   * Returns 1 when the new timer is the leftmost timer in the tree.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
825
   */
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
826
827
  static int enqueue_hrtimer(struct hrtimer *timer,
  			   struct hrtimer_clock_base *base)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
828
  {
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
829
  	debug_activate(timer);
237fc6e7a   Thomas Gleixner   add hrtimer speci...
830

998adc3dd   John Stultz   hrtimers: Convert...
831
  	timerqueue_add(&base->active, &timer->node);
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
832
  	base->cpu_base->active_bases |= 1 << base->index;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
833

303e967ff   Thomas Gleixner   [PATCH] hrtimers;...
834
835
836
837
838
  	/*
  	 * HRTIMER_STATE_ENQUEUED is or'ed to the current state to preserve the
  	 * state of a possibly running callback.
  	 */
  	timer->state |= HRTIMER_STATE_ENQUEUED;
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
839

998adc3dd   John Stultz   hrtimers: Convert...
840
  	return (&timer->node == base->active.next);
288867ec5   Thomas Gleixner   [hrtimer] Remove ...
841
  }
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
842
843
844
845
846
  
  /*
   * __remove_hrtimer - internal function to remove a timer
   *
   * Caller must hold the base lock.
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
847
848
849
850
851
   *
   * High resolution timer mode reprograms the clock event device when the
   * timer is the one which expires next. The caller can disable this by setting
   * reprogram to zero. This is useful, when the context does a reprogramming
   * anyway (e.g. timer interrupt)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
852
   */
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
853
  static void __remove_hrtimer(struct hrtimer *timer,
303e967ff   Thomas Gleixner   [PATCH] hrtimers;...
854
  			     struct hrtimer_clock_base *base,
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
855
  			     unsigned long newstate, int reprogram)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
856
  {
27c9cd7e6   Jeff Ohlstein   hrtimer: Fix extr...
857
  	struct timerqueue_node *next_timer;
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
858
859
  	if (!(timer->state & HRTIMER_STATE_ENQUEUED))
  		goto out;
27c9cd7e6   Jeff Ohlstein   hrtimer: Fix extr...
860
861
862
  	next_timer = timerqueue_getnext(&base->active);
  	timerqueue_del(&base->active, &timer->node);
  	if (&timer->node == next_timer) {
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
863
864
865
866
867
868
869
870
871
  #ifdef CONFIG_HIGH_RES_TIMERS
  		/* Reprogram the clock event device. if enabled */
  		if (reprogram && hrtimer_hres_active()) {
  			ktime_t expires;
  
  			expires = ktime_sub(hrtimer_get_expires(timer),
  					    base->offset);
  			if (base->cpu_base->expires_next.tv64 == expires.tv64)
  				hrtimer_force_reprogram(base->cpu_base, 1);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
872
  		}
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
873
  #endif
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
874
  	}
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
875
876
  	if (!timerqueue_getnext(&base->active))
  		base->cpu_base->active_bases &= ~(1 << base->index);
7403f41f1   Ashwin Chaugule   hrtimer: Eliminat...
877
  out:
303e967ff   Thomas Gleixner   [PATCH] hrtimers;...
878
  	timer->state = newstate;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
879
880
881
882
883
884
  }
  
  /*
   * remove hrtimer, called with base lock held
   */
  static inline int
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
885
  remove_hrtimer(struct hrtimer *timer, struct hrtimer_clock_base *base)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
886
  {
303e967ff   Thomas Gleixner   [PATCH] hrtimers;...
887
  	if (hrtimer_is_queued(timer)) {
f13d4f979   Salman Qazi   hrtimer: Preserve...
888
  		unsigned long state;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
889
890
891
892
893
894
895
896
897
898
  		int reprogram;
  
  		/*
  		 * Remove the timer and force reprogramming when high
  		 * resolution mode is active and the timer is on the current
  		 * CPU. If we remove a timer on another CPU, reprogramming is
  		 * skipped. The interrupt event on this CPU is fired and
  		 * reprogramming happens in the interrupt handler. This is a
  		 * rare case and less expensive than a smp call.
  		 */
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
899
  		debug_deactivate(timer);
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
900
  		timer_stats_hrtimer_clear_start_info(timer);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
901
  		reprogram = base->cpu_base == &__get_cpu_var(hrtimer_bases);
f13d4f979   Salman Qazi   hrtimer: Preserve...
902
903
904
905
906
907
908
  		/*
  		 * We must preserve the CALLBACK state flag here,
  		 * otherwise we could move the timer base in
  		 * switch_hrtimer_base.
  		 */
  		state = timer->state & HRTIMER_STATE_CALLBACK;
  		__remove_hrtimer(timer, base, state, reprogram);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
909
910
911
912
  		return 1;
  	}
  	return 0;
  }
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
913
914
915
  int __hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
  		unsigned long delta_ns, const enum hrtimer_mode mode,
  		int wakeup)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
916
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
917
  	struct hrtimer_clock_base *base, *new_base;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
918
  	unsigned long flags;
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
919
  	int ret, leftmost;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
920
921
922
923
924
925
926
  
  	base = lock_hrtimer_base(timer, &flags);
  
  	/* Remove an active timer from the queue: */
  	ret = remove_hrtimer(timer, base);
  
  	/* Switch the timer base, if necessary: */
597d02757   Arun R Bharadwaj   timers: Framework...
927
  	new_base = switch_hrtimer_base(timer, base, mode & HRTIMER_MODE_PINNED);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
928

597d02757   Arun R Bharadwaj   timers: Framework...
929
  	if (mode & HRTIMER_MODE_REL) {
5a7780e72   Thomas Gleixner   hrtimer: check re...
930
  		tim = ktime_add_safe(tim, new_base->get_time());
06027bdd2   Ingo Molnar   [PATCH] hrtimer: ...
931
932
933
934
935
936
937
938
  		/*
  		 * CONFIG_TIME_LOW_RES is a temporary way for architectures
  		 * to signal that they simply return xtime in
  		 * do_gettimeoffset(). In this case we want to round up by
  		 * resolution when starting a relative timer, to avoid short
  		 * timeouts. This will go away with the GTOD framework.
  		 */
  #ifdef CONFIG_TIME_LOW_RES
5a7780e72   Thomas Gleixner   hrtimer: check re...
939
  		tim = ktime_add_safe(tim, base->resolution);
06027bdd2   Ingo Molnar   [PATCH] hrtimer: ...
940
941
  #endif
  	}
237fc6e7a   Thomas Gleixner   add hrtimer speci...
942

da8f2e170   Arjan van de Ven   hrtimer: add a hr...
943
  	hrtimer_set_expires_range_ns(timer, tim, delta_ns);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
944

82f67cd9f   Ingo Molnar   [PATCH] Add debug...
945
  	timer_stats_hrtimer_set_start_info(timer);
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
946
  	leftmost = enqueue_hrtimer(timer, new_base);
935c631db   Ingo Molnar   [PATCH] hrtimers:...
947
948
949
  	/*
  	 * Only allow reprogramming if the new base is on this CPU.
  	 * (it might still be on another CPU if the timer was pending)
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
950
951
  	 *
  	 * XXX send_remote_softirq() ?
935c631db   Ingo Molnar   [PATCH] hrtimers:...
952
  	 */
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
953
  	if (leftmost && new_base->cpu_base == &__get_cpu_var(hrtimer_bases))
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
954
  		hrtimer_enqueue_reprogram(timer, new_base, wakeup);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
955
956
957
958
959
  
  	unlock_hrtimer_base(timer, &flags);
  
  	return ret;
  }
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
  
  /**
   * hrtimer_start_range_ns - (re)start an hrtimer on the current CPU
   * @timer:	the timer to be added
   * @tim:	expiry time
   * @delta_ns:	"slack" range for the timer
   * @mode:	expiry mode: absolute (HRTIMER_ABS) or relative (HRTIMER_REL)
   *
   * Returns:
   *  0 on success
   *  1 when the timer was active
   */
  int hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim,
  		unsigned long delta_ns, const enum hrtimer_mode mode)
  {
  	return __hrtimer_start_range_ns(timer, tim, delta_ns, mode, 1);
  }
da8f2e170   Arjan van de Ven   hrtimer: add a hr...
977
978
979
  EXPORT_SYMBOL_GPL(hrtimer_start_range_ns);
  
  /**
e1dd7bc58   Thomas Gleixner   hrtimers: fix doc...
980
   * hrtimer_start - (re)start an hrtimer on the current CPU
da8f2e170   Arjan van de Ven   hrtimer: add a hr...
981
982
983
984
985
986
987
988
989
990
991
   * @timer:	the timer to be added
   * @tim:	expiry time
   * @mode:	expiry mode: absolute (HRTIMER_ABS) or relative (HRTIMER_REL)
   *
   * Returns:
   *  0 on success
   *  1 when the timer was active
   */
  int
  hrtimer_start(struct hrtimer *timer, ktime_t tim, const enum hrtimer_mode mode)
  {
7f1e2ca9f   Peter Zijlstra   hrtimer: fix rq->...
992
  	return __hrtimer_start_range_ns(timer, tim, 0, mode, 1);
da8f2e170   Arjan van de Ven   hrtimer: add a hr...
993
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
994
  EXPORT_SYMBOL_GPL(hrtimer_start);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
995

da8f2e170   Arjan van de Ven   hrtimer: add a hr...
996

c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
997
998
  /**
   * hrtimer_try_to_cancel - try to deactivate a timer
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
999
1000
1001
1002
1003
1004
   * @timer:	hrtimer to stop
   *
   * Returns:
   *  0 when the timer was not active
   *  1 when the timer was active
   * -1 when the timer is currently excuting the callback function and
fa9799e33   Randy Dunlap   [PATCH] ktime/hrt...
1005
   *    cannot be stopped
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1006
1007
1008
   */
  int hrtimer_try_to_cancel(struct hrtimer *timer)
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1009
  	struct hrtimer_clock_base *base;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1010
1011
1012
1013
  	unsigned long flags;
  	int ret = -1;
  
  	base = lock_hrtimer_base(timer, &flags);
303e967ff   Thomas Gleixner   [PATCH] hrtimers;...
1014
  	if (!hrtimer_callback_running(timer))
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1015
1016
1017
1018
1019
1020
1021
  		ret = remove_hrtimer(timer, base);
  
  	unlock_hrtimer_base(timer, &flags);
  
  	return ret;
  
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
1022
  EXPORT_SYMBOL_GPL(hrtimer_try_to_cancel);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1023
1024
1025
  
  /**
   * hrtimer_cancel - cancel a timer and wait for the handler to finish.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
   * @timer:	the timer to be cancelled
   *
   * Returns:
   *  0 when the timer was not active
   *  1 when the timer was active
   */
  int hrtimer_cancel(struct hrtimer *timer)
  {
  	for (;;) {
  		int ret = hrtimer_try_to_cancel(timer);
  
  		if (ret >= 0)
  			return ret;
5ef37b196   Joe Korty   [PATCH] add cpu_r...
1039
  		cpu_relax();
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1040
1041
  	}
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
1042
  EXPORT_SYMBOL_GPL(hrtimer_cancel);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1043
1044
1045
  
  /**
   * hrtimer_get_remaining - get remaining time for the timer
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1046
1047
1048
1049
   * @timer:	the timer to read
   */
  ktime_t hrtimer_get_remaining(const struct hrtimer *timer)
  {
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1050
1051
  	unsigned long flags;
  	ktime_t rem;
b3bd3de66   Andi Kleen   gcc-4.6: kernel/*...
1052
  	lock_hrtimer_base(timer, &flags);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1053
  	rem = hrtimer_expires_remaining(timer);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1054
1055
1056
1057
  	unlock_hrtimer_base(timer, &flags);
  
  	return rem;
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
1058
  EXPORT_SYMBOL_GPL(hrtimer_get_remaining);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1059

ee9c57852   Russell King   dyntick: Remove l...
1060
  #ifdef CONFIG_NO_HZ
69239749e   Tony Lindgren   [PATCH] fix next_...
1061
1062
1063
1064
1065
1066
1067
1068
  /**
   * hrtimer_get_next_event - get the time until next expiry event
   *
   * Returns the delta to the next expiry event or KTIME_MAX if no timer
   * is pending.
   */
  ktime_t hrtimer_get_next_event(void)
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1069
1070
  	struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
  	struct hrtimer_clock_base *base = cpu_base->clock_base;
69239749e   Tony Lindgren   [PATCH] fix next_...
1071
1072
1073
  	ktime_t delta, mindelta = { .tv64 = KTIME_MAX };
  	unsigned long flags;
  	int i;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1074
  	raw_spin_lock_irqsave(&cpu_base->lock, flags);
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1075

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1076
1077
1078
  	if (!hrtimer_hres_active()) {
  		for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++, base++) {
  			struct hrtimer *timer;
998adc3dd   John Stultz   hrtimers: Convert...
1079
  			struct timerqueue_node *next;
69239749e   Tony Lindgren   [PATCH] fix next_...
1080

998adc3dd   John Stultz   hrtimers: Convert...
1081
1082
  			next = timerqueue_getnext(&base->active);
  			if (!next)
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1083
  				continue;
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1084

998adc3dd   John Stultz   hrtimers: Convert...
1085
  			timer = container_of(next, struct hrtimer, node);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1086
  			delta.tv64 = hrtimer_get_expires_tv64(timer);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1087
1088
1089
1090
  			delta = ktime_sub(delta, base->get_time());
  			if (delta.tv64 < mindelta.tv64)
  				mindelta.tv64 = delta.tv64;
  		}
69239749e   Tony Lindgren   [PATCH] fix next_...
1091
  	}
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1092

ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1093
  	raw_spin_unlock_irqrestore(&cpu_base->lock, flags);
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1094

69239749e   Tony Lindgren   [PATCH] fix next_...
1095
1096
1097
1098
1099
  	if (mindelta.tv64 < 0)
  		mindelta.tv64 = 0;
  	return mindelta;
  }
  #endif
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1100
1101
  static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  			   enum hrtimer_mode mode)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1102
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1103
  	struct hrtimer_cpu_base *cpu_base;
e06383db9   John Stultz   hrtimers: extend ...
1104
  	int base;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1105

7978672c4   George Anzinger   [PATCH] hrtimers:...
1106
  	memset(timer, 0, sizeof(struct hrtimer));
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1107
  	cpu_base = &__raw_get_cpu_var(hrtimer_bases);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1108

c9cb2e3d7   Thomas Gleixner   [PATCH] hrtimers:...
1109
  	if (clock_id == CLOCK_REALTIME && mode != HRTIMER_MODE_ABS)
7978672c4   George Anzinger   [PATCH] hrtimers:...
1110
  		clock_id = CLOCK_MONOTONIC;
e06383db9   John Stultz   hrtimers: extend ...
1111
1112
  	base = hrtimer_clockid_to_base(clock_id);
  	timer->base = &cpu_base->clock_base[base];
998adc3dd   John Stultz   hrtimers: Convert...
1113
  	timerqueue_init(&timer->node);
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
1114
1115
1116
1117
1118
1119
  
  #ifdef CONFIG_TIMER_STATS
  	timer->start_site = NULL;
  	timer->start_pid = -1;
  	memset(timer->start_comm, 0, TASK_COMM_LEN);
  #endif
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1120
  }
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
  
  /**
   * hrtimer_init - initialize a timer to the given clock
   * @timer:	the timer to be initialized
   * @clock_id:	the clock to be used
   * @mode:	timer mode abs/rel
   */
  void hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  		  enum hrtimer_mode mode)
  {
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1131
  	debug_init(timer, clock_id, mode);
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1132
1133
  	__hrtimer_init(timer, clock_id, mode);
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
1134
  EXPORT_SYMBOL_GPL(hrtimer_init);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1135
1136
1137
  
  /**
   * hrtimer_get_res - get the timer resolution for a clock
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1138
1139
1140
   * @which_clock: which clock to query
   * @tp:		 pointer to timespec variable to store the resolution
   *
72fd4a35a   Robert P. J. Day   [PATCH] Numerous ...
1141
1142
   * Store the resolution of the clock selected by @which_clock in the
   * variable pointed to by @tp.
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1143
1144
1145
   */
  int hrtimer_get_res(const clockid_t which_clock, struct timespec *tp)
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1146
  	struct hrtimer_cpu_base *cpu_base;
e06383db9   John Stultz   hrtimers: extend ...
1147
  	int base = hrtimer_clockid_to_base(which_clock);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1148

3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1149
  	cpu_base = &__raw_get_cpu_var(hrtimer_bases);
e06383db9   John Stultz   hrtimers: extend ...
1150
  	*tp = ktime_to_timespec(cpu_base->clock_base[base].resolution);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1151
1152
1153
  
  	return 0;
  }
8d16b7642   Stephen Hemminger   [PATCH] hrtimer: ...
1154
  EXPORT_SYMBOL_GPL(hrtimer_get_res);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1155

c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1156
  static void __run_hrtimer(struct hrtimer *timer, ktime_t *now)
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1157
1158
1159
1160
1161
  {
  	struct hrtimer_clock_base *base = timer->base;
  	struct hrtimer_cpu_base *cpu_base = base->cpu_base;
  	enum hrtimer_restart (*fn)(struct hrtimer *);
  	int restart;
ca109491f   Peter Zijlstra   hrtimer: removing...
1162
  	WARN_ON(!irqs_disabled());
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1163
  	debug_deactivate(timer);
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1164
1165
  	__remove_hrtimer(timer, base, HRTIMER_STATE_CALLBACK, 0);
  	timer_stats_account_hrtimer(timer);
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1166
  	fn = timer->function;
ca109491f   Peter Zijlstra   hrtimer: removing...
1167
1168
1169
1170
1171
1172
  
  	/*
  	 * Because we run timers from hardirq context, there is no chance
  	 * they get migrated to another cpu, therefore its safe to unlock
  	 * the timer base.
  	 */
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1173
  	raw_spin_unlock(&cpu_base->lock);
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1174
  	trace_hrtimer_expire_entry(timer, now);
ca109491f   Peter Zijlstra   hrtimer: removing...
1175
  	restart = fn(timer);
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1176
  	trace_hrtimer_expire_exit(timer);
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1177
  	raw_spin_lock(&cpu_base->lock);
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1178
1179
  
  	/*
e3f1d8837   Thomas Gleixner   hrtimer: fixup co...
1180
1181
1182
  	 * Note: We clear the CALLBACK bit after enqueue_hrtimer and
  	 * we do not reprogramm the event hardware. Happens either in
  	 * hrtimer_start_range_ns() or in hrtimer_interrupt()
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1183
1184
1185
  	 */
  	if (restart != HRTIMER_NORESTART) {
  		BUG_ON(timer->state != HRTIMER_STATE_CALLBACK);
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
1186
  		enqueue_hrtimer(timer, base);
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1187
  	}
f13d4f979   Salman Qazi   hrtimer: Preserve...
1188
1189
  
  	WARN_ON_ONCE(!(timer->state & HRTIMER_STATE_CALLBACK));
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1190
1191
  	timer->state &= ~HRTIMER_STATE_CALLBACK;
  }
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1192
1193
1194
1195
1196
1197
1198
1199
1200
  #ifdef CONFIG_HIGH_RES_TIMERS
  
  /*
   * High resolution timer interrupt
   * Called with interrupts disabled
   */
  void hrtimer_interrupt(struct clock_event_device *dev)
  {
  	struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
1201
1202
  	ktime_t expires_next, now, entry_time, delta;
  	int i, retries = 0;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1203
1204
1205
1206
  
  	BUG_ON(!cpu_base->hres_active);
  	cpu_base->nr_events++;
  	dev->next_event.tv64 = KTIME_MAX;
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
1207
1208
  	entry_time = now = ktime_get();
  retry:
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1209
  	expires_next.tv64 = KTIME_MAX;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1210
  	raw_spin_lock(&cpu_base->lock);
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
1211
1212
1213
1214
1215
1216
1217
1218
  	/*
  	 * We set expires_next to KTIME_MAX here with cpu_base->lock
  	 * held to prevent that a timer is enqueued in our queue via
  	 * the migration code. This does not affect enqueueing of
  	 * timers which run their callback and need to be requeued on
  	 * this CPU.
  	 */
  	cpu_base->expires_next.tv64 = KTIME_MAX;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1219
  	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
1220
  		struct hrtimer_clock_base *base;
998adc3dd   John Stultz   hrtimers: Convert...
1221
  		struct timerqueue_node *node;
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
1222
1223
1224
1225
  		ktime_t basenow;
  
  		if (!(cpu_base->active_bases & (1 << i)))
  			continue;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1226

ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
1227
  		base = cpu_base->clock_base + i;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1228
  		basenow = ktime_add(now, base->offset);
998adc3dd   John Stultz   hrtimers: Convert...
1229
  		while ((node = timerqueue_getnext(&base->active))) {
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1230
  			struct hrtimer *timer;
998adc3dd   John Stultz   hrtimers: Convert...
1231
  			timer = container_of(node, struct hrtimer, node);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1232

654c8e0b1   Arjan van de Ven   hrtimer: turn hrt...
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
  			/*
  			 * The immediate goal for using the softexpires is
  			 * minimizing wakeups, not running timers at the
  			 * earliest interrupt after their soft expiration.
  			 * This allows us to avoid using a Priority Search
  			 * Tree, which can answer a stabbing querry for
  			 * overlapping intervals and instead use the simple
  			 * BST we already have.
  			 * We don't add extra wakeups by delaying timers that
  			 * are right-of a not yet expired timer, because that
  			 * timer will have to trigger a wakeup anyway.
  			 */
  
  			if (basenow.tv64 < hrtimer_get_softexpires_tv64(timer)) {
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1247
  				ktime_t expires;
cc584b213   Arjan van de Ven   hrtimer: convert ...
1248
  				expires = ktime_sub(hrtimer_get_expires(timer),
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1249
1250
1251
1252
1253
  						    base->offset);
  				if (expires.tv64 < expires_next.tv64)
  					expires_next = expires;
  				break;
  			}
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1254
  			__run_hrtimer(timer, &basenow);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1255
  		}
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1256
  	}
6ff7041db   Thomas Gleixner   hrtimer: Fix migr...
1257
1258
1259
1260
  	/*
  	 * Store the new expiry value so the migration code can verify
  	 * against it.
  	 */
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1261
  	cpu_base->expires_next = expires_next;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1262
  	raw_spin_unlock(&cpu_base->lock);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1263
1264
  
  	/* Reprogramming necessary ? */
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
1265
1266
1267
1268
  	if (expires_next.tv64 == KTIME_MAX ||
  	    !tick_program_event(expires_next, 0)) {
  		cpu_base->hang_detected = 0;
  		return;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1269
  	}
41d2e4949   Thomas Gleixner   hrtimer: Tune hrt...
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306
1307
  
  	/*
  	 * The next timer was already expired due to:
  	 * - tracing
  	 * - long lasting callbacks
  	 * - being scheduled away when running in a VM
  	 *
  	 * We need to prevent that we loop forever in the hrtimer
  	 * interrupt routine. We give it 3 attempts to avoid
  	 * overreacting on some spurious event.
  	 */
  	now = ktime_get();
  	cpu_base->nr_retries++;
  	if (++retries < 3)
  		goto retry;
  	/*
  	 * Give the system a chance to do something else than looping
  	 * here. We stored the entry time, so we know exactly how long
  	 * we spent here. We schedule the next event this amount of
  	 * time away.
  	 */
  	cpu_base->nr_hangs++;
  	cpu_base->hang_detected = 1;
  	delta = ktime_sub(now, entry_time);
  	if (delta.tv64 > cpu_base->max_hang_time.tv64)
  		cpu_base->max_hang_time = delta;
  	/*
  	 * Limit it to a sensible value as we enforce a longer
  	 * delay. Give the CPU at least 100ms to catch up.
  	 */
  	if (delta.tv64 > 100 * NSEC_PER_MSEC)
  		expires_next = ktime_add_ns(now, 100 * NSEC_PER_MSEC);
  	else
  		expires_next = ktime_add(now, delta);
  	tick_program_event(expires_next, 1);
  	printk_once(KERN_WARNING "hrtimer: interrupt took %llu ns
  ",
  		    ktime_to_ns(delta));
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1308
  }
8bdec955b   Thomas Gleixner   hrtimer: splitout...
1309
1310
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
  /*
   * local version of hrtimer_peek_ahead_timers() called with interrupts
   * disabled.
   */
  static void __hrtimer_peek_ahead_timers(void)
  {
  	struct tick_device *td;
  
  	if (!hrtimer_hres_active())
  		return;
  
  	td = &__get_cpu_var(tick_cpu_device);
  	if (td && td->evtdev)
  		hrtimer_interrupt(td->evtdev);
  }
2e94d1f71   Arjan van de Ven   hrtimer: peek at ...
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
  /**
   * hrtimer_peek_ahead_timers -- run soft-expired timers now
   *
   * hrtimer_peek_ahead_timers will peek at the timer queue of
   * the current cpu and check if there are any timers for which
   * the soft expires time has passed. If any such timers exist,
   * they are run immediately and then removed from the timer queue.
   *
   */
  void hrtimer_peek_ahead_timers(void)
  {
643bdf68f   Thomas Gleixner   hrtimers: simplif...
1335
  	unsigned long flags;
dc4304f7d   Arjan van de Ven   rangetimers: fix ...
1336

2e94d1f71   Arjan van de Ven   hrtimer: peek at ...
1337
  	local_irq_save(flags);
8bdec955b   Thomas Gleixner   hrtimer: splitout...
1338
  	__hrtimer_peek_ahead_timers();
2e94d1f71   Arjan van de Ven   hrtimer: peek at ...
1339
1340
  	local_irq_restore(flags);
  }
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
1341
1342
1343
1344
  static void run_hrtimer_softirq(struct softirq_action *h)
  {
  	hrtimer_peek_ahead_timers();
  }
82c5b7b52   Ingo Molnar   hrtimer: splitout...
1345
1346
1347
1348
1349
  #else /* CONFIG_HIGH_RES_TIMERS */
  
  static inline void __hrtimer_peek_ahead_timers(void) { }
  
  #endif	/* !CONFIG_HIGH_RES_TIMERS */
82f67cd9f   Ingo Molnar   [PATCH] Add debug...
1350

d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1351
1352
1353
1354
1355
1356
1357
1358
1359
  /*
   * Called from timer softirq every jiffy, expire hrtimers:
   *
   * For HRT its the fall back code to run the softirq in the timer
   * softirq context in case the hrtimer initialization failed or has
   * not been done yet.
   */
  void hrtimer_run_pending(void)
  {
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1360
1361
  	if (hrtimer_hres_active())
  		return;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1362

d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1363
1364
1365
1366
1367
1368
1369
1370
1371
1372
  	/*
  	 * This _is_ ugly: We have to check in the softirq context,
  	 * whether we can switch to highres and / or nohz mode. The
  	 * clocksource switch happens in the timer interrupt with
  	 * xtime_lock held. Notification from there only sets the
  	 * check bit in the tick_oneshot code, otherwise we might
  	 * deadlock vs. xtime_lock.
  	 */
  	if (tick_check_oneshot_change(!hrtimer_is_hres_enabled()))
  		hrtimer_switch_to_hres();
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1373
  }
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1374
  /*
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1375
   * Called from hardirq context every jiffy
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1376
   */
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1377
  void hrtimer_run_queues(void)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1378
  {
998adc3dd   John Stultz   hrtimers: Convert...
1379
  	struct timerqueue_node *node;
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1380
1381
1382
  	struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
  	struct hrtimer_clock_base *base;
  	int index, gettime = 1;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1383

833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1384
  	if (hrtimer_hres_active())
3055addad   Dimitri Sivanich   [PATCH] hrtimer: ...
1385
  		return;
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1386
1387
  	for (index = 0; index < HRTIMER_MAX_CLOCK_BASES; index++) {
  		base = &cpu_base->clock_base[index];
b007c389d   John Stultz   hrtimer: fix time...
1388
  		if (!timerqueue_getnext(&base->active))
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1389
  			continue;
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1390

d7cfb60c5   Mark McLoughlin   hrtimer: remove h...
1391
  		if (gettime) {
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1392
1393
  			hrtimer_get_softirq_time(cpu_base);
  			gettime = 0;
b75f7a51c   Roman Zippel   [PATCH] hrtimers:...
1394
  		}
d3d74453c   Peter Zijlstra   hrtimer: fixup th...
1395

ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1396
  		raw_spin_lock(&cpu_base->lock);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1397

b007c389d   John Stultz   hrtimer: fix time...
1398
  		while ((node = timerqueue_getnext(&base->active))) {
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1399
  			struct hrtimer *timer;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1400

998adc3dd   John Stultz   hrtimers: Convert...
1401
  			timer = container_of(node, struct hrtimer, node);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1402
1403
  			if (base->softirq_time.tv64 <=
  					hrtimer_get_expires_tv64(timer))
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1404
  				break;
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1405
  			__run_hrtimer(timer, &base->softirq_time);
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1406
  		}
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1407
  		raw_spin_unlock(&cpu_base->lock);
833883d9a   Dimitri Sivanich   hrtimer: reduce c...
1408
  	}
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1409
1410
1411
  }
  
  /*
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1412
1413
   * Sleep related functions:
   */
c9cb2e3d7   Thomas Gleixner   [PATCH] hrtimers:...
1414
  static enum hrtimer_restart hrtimer_wakeup(struct hrtimer *timer)
00362e33f   Thomas Gleixner   [PATCH] hrtimer: ...
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
  {
  	struct hrtimer_sleeper *t =
  		container_of(timer, struct hrtimer_sleeper, timer);
  	struct task_struct *task = t->task;
  
  	t->task = NULL;
  	if (task)
  		wake_up_process(task);
  
  	return HRTIMER_NORESTART;
  }
36c8b5868   Ingo Molnar   [PATCH] sched: cl...
1426
  void hrtimer_init_sleeper(struct hrtimer_sleeper *sl, struct task_struct *task)
00362e33f   Thomas Gleixner   [PATCH] hrtimer: ...
1427
1428
1429
1430
  {
  	sl->timer.function = hrtimer_wakeup;
  	sl->task = task;
  }
2bc481cf4   Stephen Hemminger   pktgen: spin usin...
1431
  EXPORT_SYMBOL_GPL(hrtimer_init_sleeper);
00362e33f   Thomas Gleixner   [PATCH] hrtimer: ...
1432

669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1433
  static int __sched do_nanosleep(struct hrtimer_sleeper *t, enum hrtimer_mode mode)
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1434
  {
669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1435
  	hrtimer_init_sleeper(t, current);
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1436

432569bb9   Roman Zippel   [PATCH] hrtimers:...
1437
1438
  	do {
  		set_current_state(TASK_INTERRUPTIBLE);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1439
  		hrtimer_start_expires(&t->timer, mode);
37bb6cb40   Peter Zijlstra   hrtimer: unlock h...
1440
1441
  		if (!hrtimer_active(&t->timer))
  			t->task = NULL;
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1442

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1443
1444
  		if (likely(t->task))
  			schedule();
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1445

669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1446
  		hrtimer_cancel(&t->timer);
c9cb2e3d7   Thomas Gleixner   [PATCH] hrtimers:...
1447
  		mode = HRTIMER_MODE_ABS;
669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1448
1449
  
  	} while (t->task && !signal_pending(current));
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1450

3588a085c   Peter Zijlstra   hrtimer: fix hrti...
1451
  	__set_current_state(TASK_RUNNING);
669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1452
  	return t->task == NULL;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1453
  }
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1454
1455
1456
1457
  static int update_rmtp(struct hrtimer *timer, struct timespec __user *rmtp)
  {
  	struct timespec rmt;
  	ktime_t rem;
cc584b213   Arjan van de Ven   hrtimer: convert ...
1458
  	rem = hrtimer_expires_remaining(timer);
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1459
1460
1461
1462
1463
1464
1465
1466
1467
  	if (rem.tv64 <= 0)
  		return 0;
  	rmt = ktime_to_timespec(rem);
  
  	if (copy_to_user(rmtp, &rmt, sizeof(*rmtp)))
  		return -EFAULT;
  
  	return 1;
  }
1711ef386   Toyo Abe   [PATCH] posix-tim...
1468
  long __sched hrtimer_nanosleep_restart(struct restart_block *restart)
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1469
  {
669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1470
  	struct hrtimer_sleeper t;
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1471
  	struct timespec __user  *rmtp;
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1472
  	int ret = 0;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1473

ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
1474
  	hrtimer_init_on_stack(&t.timer, restart->nanosleep.clockid,
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1475
  				HRTIMER_MODE_ABS);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1476
  	hrtimer_set_expires_tv64(&t.timer, restart->nanosleep.expires);
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1477

c9cb2e3d7   Thomas Gleixner   [PATCH] hrtimers:...
1478
  	if (do_nanosleep(&t, HRTIMER_MODE_ABS))
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1479
  		goto out;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1480

029a07e03   Thomas Gleixner   hrtimer: use nano...
1481
  	rmtp = restart->nanosleep.rmtp;
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1482
  	if (rmtp) {
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1483
  		ret = update_rmtp(&t.timer, rmtp);
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1484
  		if (ret <= 0)
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1485
  			goto out;
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1486
  	}
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1487

10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1488
  	/* The other values in restart are already filled in */
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1489
1490
1491
1492
  	ret = -ERESTART_RESTARTBLOCK;
  out:
  	destroy_hrtimer_on_stack(&t.timer);
  	return ret;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1493
  }
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1494
  long hrtimer_nanosleep(struct timespec *rqtp, struct timespec __user *rmtp,
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1495
1496
1497
  		       const enum hrtimer_mode mode, const clockid_t clockid)
  {
  	struct restart_block *restart;
669d7868a   Thomas Gleixner   [PATCH] hrtimer: ...
1498
  	struct hrtimer_sleeper t;
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1499
  	int ret = 0;
3bd012060   Arjan van de Ven   hrtimer: make the...
1500
1501
1502
1503
1504
  	unsigned long slack;
  
  	slack = current->timer_slack_ns;
  	if (rt_task(current))
  		slack = 0;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1505

237fc6e7a   Thomas Gleixner   add hrtimer speci...
1506
  	hrtimer_init_on_stack(&t.timer, clockid, mode);
3bd012060   Arjan van de Ven   hrtimer: make the...
1507
  	hrtimer_set_expires_range_ns(&t.timer, timespec_to_ktime(*rqtp), slack);
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1508
  	if (do_nanosleep(&t, mode))
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1509
  		goto out;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1510

7978672c4   George Anzinger   [PATCH] hrtimers:...
1511
  	/* Absolute timers do not update the rmtp value and restart: */
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1512
1513
1514
1515
  	if (mode == HRTIMER_MODE_ABS) {
  		ret = -ERESTARTNOHAND;
  		goto out;
  	}
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1516

432569bb9   Roman Zippel   [PATCH] hrtimers:...
1517
  	if (rmtp) {
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1518
  		ret = update_rmtp(&t.timer, rmtp);
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1519
  		if (ret <= 0)
237fc6e7a   Thomas Gleixner   add hrtimer speci...
1520
  			goto out;
432569bb9   Roman Zippel   [PATCH] hrtimers:...
1521
  	}
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1522
1523
  
  	restart = &current_thread_info()->restart_block;
1711ef386   Toyo Abe   [PATCH] posix-tim...
1524
  	restart->fn = hrtimer_nanosleep_restart;
ab8177bc5   Thomas Gleixner   hrtimers: Avoid t...
1525
  	restart->nanosleep.clockid = t.timer.base->clockid;
029a07e03   Thomas Gleixner   hrtimer: use nano...
1526
  	restart->nanosleep.rmtp = rmtp;
cc584b213   Arjan van de Ven   hrtimer: convert ...
1527
  	restart->nanosleep.expires = hrtimer_get_expires_tv64(&t.timer);
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1528

237fc6e7a   Thomas Gleixner   add hrtimer speci...
1529
1530
1531
1532
  	ret = -ERESTART_RESTARTBLOCK;
  out:
  	destroy_hrtimer_on_stack(&t.timer);
  	return ret;
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1533
  }
58fd3aa28   Heiko Carstens   [CVE-2009-0029] S...
1534
1535
  SYSCALL_DEFINE2(nanosleep, struct timespec __user *, rqtp,
  		struct timespec __user *, rmtp)
6ba1b9121   Thomas Gleixner   [PATCH] hrtimer: ...
1536
  {
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1537
  	struct timespec tu;
6ba1b9121   Thomas Gleixner   [PATCH] hrtimer: ...
1538
1539
1540
1541
1542
1543
  
  	if (copy_from_user(&tu, rqtp, sizeof(tu)))
  		return -EFAULT;
  
  	if (!timespec_valid(&tu))
  		return -EINVAL;
080344b98   Oleg Nesterov   hrtimer: fix *rmt...
1544
  	return hrtimer_nanosleep(&tu, rmtp, HRTIMER_MODE_REL, CLOCK_MONOTONIC);
6ba1b9121   Thomas Gleixner   [PATCH] hrtimer: ...
1545
  }
10c94ec16   Thomas Gleixner   [PATCH] hrtimer: ...
1546
  /*
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1547
1548
   * Functions related to boot-time initialization:
   */
0ec160dd4   Randy Dunlap   hrtimer: fix sect...
1549
  static void __cpuinit init_hrtimers_cpu(int cpu)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1550
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1551
  	struct hrtimer_cpu_base *cpu_base = &per_cpu(hrtimer_bases, cpu);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1552
  	int i;
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1553
  	raw_spin_lock_init(&cpu_base->lock);
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1554

998adc3dd   John Stultz   hrtimers: Convert...
1555
  	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1556
  		cpu_base->clock_base[i].cpu_base = cpu_base;
998adc3dd   John Stultz   hrtimers: Convert...
1557
1558
  		timerqueue_init_head(&cpu_base->clock_base[i].active);
  	}
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1559

54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1560
  	hrtimer_init_hres(cpu_base);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1561
1562
1563
  }
  
  #ifdef CONFIG_HOTPLUG_CPU
ca109491f   Peter Zijlstra   hrtimer: removing...
1564
  static void migrate_hrtimer_list(struct hrtimer_clock_base *old_base,
37810659e   Peter Zijlstra   hrtimer: removing...
1565
  				struct hrtimer_clock_base *new_base)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1566
1567
  {
  	struct hrtimer *timer;
998adc3dd   John Stultz   hrtimers: Convert...
1568
  	struct timerqueue_node *node;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1569

998adc3dd   John Stultz   hrtimers: Convert...
1570
1571
  	while ((node = timerqueue_getnext(&old_base->active))) {
  		timer = container_of(node, struct hrtimer, node);
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1572
  		BUG_ON(hrtimer_callback_running(timer));
c6a2a1770   Xiao Guangrong   hrtimer: Add trac...
1573
  		debug_deactivate(timer);
b00c1a99e   Thomas Gleixner   hrtimer: mark mig...
1574
1575
1576
1577
1578
1579
1580
  
  		/*
  		 * Mark it as STATE_MIGRATE not INACTIVE otherwise the
  		 * timer could be seen as !active and just vanish away
  		 * under us on another CPU
  		 */
  		__remove_hrtimer(timer, old_base, HRTIMER_STATE_MIGRATE, 0);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1581
  		timer->base = new_base;
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1582
  		/*
e3f1d8837   Thomas Gleixner   hrtimer: fixup co...
1583
1584
1585
1586
1587
1588
  		 * Enqueue the timers on the new cpu. This does not
  		 * reprogram the event device in case the timer
  		 * expires before the earliest on this CPU, but we run
  		 * hrtimer_interrupt after we migrated everything to
  		 * sort out already expired timers and reprogram the
  		 * event device.
54cdfdb47   Thomas Gleixner   [PATCH] hrtimers:...
1589
  		 */
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
1590
  		enqueue_hrtimer(timer, new_base);
41e1022ea   Thomas Gleixner   hrtimer: fix migr...
1591

b00c1a99e   Thomas Gleixner   hrtimer: mark mig...
1592
1593
  		/* Clear the migration state bit */
  		timer->state &= ~HRTIMER_STATE_MIGRATE;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1594
1595
  	}
  }
d5fd43c4a   Thomas Gleixner   hrtimer: fix HOTP...
1596
  static void migrate_hrtimers(int scpu)
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1597
  {
3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1598
  	struct hrtimer_cpu_base *old_base, *new_base;
731a55ba0   Thomas Gleixner   hrtimer: simplify...
1599
  	int i;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1600

37810659e   Peter Zijlstra   hrtimer: removing...
1601
  	BUG_ON(cpu_online(scpu));
37810659e   Peter Zijlstra   hrtimer: removing...
1602
  	tick_cancel_sched_timer(scpu);
731a55ba0   Thomas Gleixner   hrtimer: simplify...
1603
1604
1605
1606
  
  	local_irq_disable();
  	old_base = &per_cpu(hrtimer_bases, scpu);
  	new_base = &__get_cpu_var(hrtimer_bases);
d82f0b0f6   Oleg Nesterov   migrate_timers: a...
1607
1608
1609
1610
  	/*
  	 * The caller is globally serialized and nobody else
  	 * takes two locks at once, deadlock is not possible.
  	 */
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1611
1612
  	raw_spin_lock(&new_base->lock);
  	raw_spin_lock_nested(&old_base->lock, SINGLE_DEPTH_NESTING);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1613

3c8aa39d7   Thomas Gleixner   [PATCH] hrtimers:...
1614
  	for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
ca109491f   Peter Zijlstra   hrtimer: removing...
1615
  		migrate_hrtimer_list(&old_base->clock_base[i],
37810659e   Peter Zijlstra   hrtimer: removing...
1616
  				     &new_base->clock_base[i]);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1617
  	}
ecb49d1a6   Thomas Gleixner   hrtimers: Convert...
1618
1619
  	raw_spin_unlock(&old_base->lock);
  	raw_spin_unlock(&new_base->lock);
37810659e   Peter Zijlstra   hrtimer: removing...
1620

731a55ba0   Thomas Gleixner   hrtimer: simplify...
1621
1622
1623
  	/* Check, if we got expired work to do */
  	__hrtimer_peek_ahead_timers();
  	local_irq_enable();
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1624
  }
37810659e   Peter Zijlstra   hrtimer: removing...
1625

c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1626
  #endif /* CONFIG_HOTPLUG_CPU */
8c78f3075   Chandra Seetharaman   [PATCH] cpu hotpl...
1627
  static int __cpuinit hrtimer_cpu_notify(struct notifier_block *self,
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1628
1629
  					unsigned long action, void *hcpu)
  {
b2e3c0ade   Ingo Molnar   hrtimers: fix war...
1630
  	int scpu = (long)hcpu;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1631
1632
1633
1634
  
  	switch (action) {
  
  	case CPU_UP_PREPARE:
8bb784428   Rafael J. Wysocki   Add suspend-relat...
1635
  	case CPU_UP_PREPARE_FROZEN:
37810659e   Peter Zijlstra   hrtimer: removing...
1636
  		init_hrtimers_cpu(scpu);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1637
1638
1639
  		break;
  
  #ifdef CONFIG_HOTPLUG_CPU
94df7de02   Sebastien Dugue   hrtimers: allow t...
1640
1641
1642
1643
  	case CPU_DYING:
  	case CPU_DYING_FROZEN:
  		clockevents_notify(CLOCK_EVT_NOTIFY_CPU_DYING, &scpu);
  		break;
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1644
  	case CPU_DEAD:
8bb784428   Rafael J. Wysocki   Add suspend-relat...
1645
  	case CPU_DEAD_FROZEN:
b2e3c0ade   Ingo Molnar   hrtimers: fix war...
1646
  	{
37810659e   Peter Zijlstra   hrtimer: removing...
1647
  		clockevents_notify(CLOCK_EVT_NOTIFY_CPU_DEAD, &scpu);
d5fd43c4a   Thomas Gleixner   hrtimer: fix HOTP...
1648
  		migrate_hrtimers(scpu);
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1649
  		break;
b2e3c0ade   Ingo Molnar   hrtimers: fix war...
1650
  	}
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1651
1652
1653
1654
1655
1656
1657
1658
  #endif
  
  	default:
  		break;
  	}
  
  	return NOTIFY_OK;
  }
8c78f3075   Chandra Seetharaman   [PATCH] cpu hotpl...
1659
  static struct notifier_block __cpuinitdata hrtimers_nb = {
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1660
1661
1662
1663
1664
1665
1666
1667
  	.notifier_call = hrtimer_cpu_notify,
  };
  
  void __init hrtimers_init(void)
  {
  	hrtimer_cpu_notify(&hrtimers_nb, (unsigned long)CPU_UP_PREPARE,
  			  (void *)(long)smp_processor_id());
  	register_cpu_notifier(&hrtimers_nb);
a6037b61c   Peter Zijlstra   hrtimer: fix recu...
1668
1669
1670
  #ifdef CONFIG_HIGH_RES_TIMERS
  	open_softirq(HRTIMER_SOFTIRQ, run_hrtimer_softirq);
  #endif
c0a313296   Thomas Gleixner   [PATCH] hrtimer: ...
1671
  }
7bb67439b   Arjan van de Ven   select: Introduce...
1672
  /**
351b3f7a2   Carsten Emde   hrtimers: Provide...
1673
   * schedule_hrtimeout_range_clock - sleep until timeout
7bb67439b   Arjan van de Ven   select: Introduce...
1674
   * @expires:	timeout value (ktime_t)
654c8e0b1   Arjan van de Ven   hrtimer: turn hrt...
1675
   * @delta:	slack in expires timeout (ktime_t)
7bb67439b   Arjan van de Ven   select: Introduce...
1676
   * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
351b3f7a2   Carsten Emde   hrtimers: Provide...
1677
   * @clock:	timer clock, CLOCK_MONOTONIC or CLOCK_REALTIME
7bb67439b   Arjan van de Ven   select: Introduce...
1678
   */
351b3f7a2   Carsten Emde   hrtimers: Provide...
1679
1680
1681
  int __sched
  schedule_hrtimeout_range_clock(ktime_t *expires, unsigned long delta,
  			       const enum hrtimer_mode mode, int clock)
7bb67439b   Arjan van de Ven   select: Introduce...
1682
1683
1684
1685
1686
1687
1688
1689
1690
1691
1692
1693
1694
  {
  	struct hrtimer_sleeper t;
  
  	/*
  	 * Optimize when a zero timeout value is given. It does not
  	 * matter whether this is an absolute or a relative time.
  	 */
  	if (expires && !expires->tv64) {
  		__set_current_state(TASK_RUNNING);
  		return 0;
  	}
  
  	/*
43b210139   Namhyung Kim   hrtimer: fix a ty...
1695
  	 * A NULL parameter means "infinite"
7bb67439b   Arjan van de Ven   select: Introduce...
1696
1697
1698
1699
1700
1701
  	 */
  	if (!expires) {
  		schedule();
  		__set_current_state(TASK_RUNNING);
  		return -EINTR;
  	}
351b3f7a2   Carsten Emde   hrtimers: Provide...
1702
  	hrtimer_init_on_stack(&t.timer, clock, mode);
654c8e0b1   Arjan van de Ven   hrtimer: turn hrt...
1703
  	hrtimer_set_expires_range_ns(&t.timer, *expires, delta);
7bb67439b   Arjan van de Ven   select: Introduce...
1704
1705
  
  	hrtimer_init_sleeper(&t, current);
cc584b213   Arjan van de Ven   hrtimer: convert ...
1706
  	hrtimer_start_expires(&t.timer, mode);
7bb67439b   Arjan van de Ven   select: Introduce...
1707
1708
1709
1710
1711
1712
1713
1714
1715
1716
1717
1718
1719
  	if (!hrtimer_active(&t.timer))
  		t.task = NULL;
  
  	if (likely(t.task))
  		schedule();
  
  	hrtimer_cancel(&t.timer);
  	destroy_hrtimer_on_stack(&t.timer);
  
  	__set_current_state(TASK_RUNNING);
  
  	return !t.task ? 0 : -EINTR;
  }
351b3f7a2   Carsten Emde   hrtimers: Provide...
1720
1721
1722
1723
1724
1725
1726
1727
1728
1729
1730
1731
1732
1733
1734
1735
1736
1737
1738
1739
1740
1741
1742
1743
1744
1745
1746
1747
1748
1749
1750
1751
1752
1753
1754
  
  /**
   * schedule_hrtimeout_range - sleep until timeout
   * @expires:	timeout value (ktime_t)
   * @delta:	slack in expires timeout (ktime_t)
   * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
   *
   * Make the current task sleep until the given expiry time has
   * elapsed. The routine will return immediately unless
   * the current task state has been set (see set_current_state()).
   *
   * The @delta argument gives the kernel the freedom to schedule the
   * actual wakeup to a time that is both power and performance friendly.
   * The kernel give the normal best effort behavior for "@expires+@delta",
   * but may decide to fire the timer earlier, but no earlier than @expires.
   *
   * You can set the task state as follows -
   *
   * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
   * pass before the routine returns.
   *
   * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
   * delivered to the current task.
   *
   * The current task state is guaranteed to be TASK_RUNNING when this
   * routine returns.
   *
   * Returns 0 when the timer has expired otherwise -EINTR
   */
  int __sched schedule_hrtimeout_range(ktime_t *expires, unsigned long delta,
  				     const enum hrtimer_mode mode)
  {
  	return schedule_hrtimeout_range_clock(expires, delta, mode,
  					      CLOCK_MONOTONIC);
  }
654c8e0b1   Arjan van de Ven   hrtimer: turn hrt...
1755
1756
1757
1758
1759
1760
1761
1762
1763
1764
1765
1766
1767
1768
1769
1770
1771
1772
1773
1774
1775
1776
1777
1778
1779
1780
1781
1782
1783
  EXPORT_SYMBOL_GPL(schedule_hrtimeout_range);
  
  /**
   * schedule_hrtimeout - sleep until timeout
   * @expires:	timeout value (ktime_t)
   * @mode:	timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
   *
   * Make the current task sleep until the given expiry time has
   * elapsed. The routine will return immediately unless
   * the current task state has been set (see set_current_state()).
   *
   * You can set the task state as follows -
   *
   * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
   * pass before the routine returns.
   *
   * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
   * delivered to the current task.
   *
   * The current task state is guaranteed to be TASK_RUNNING when this
   * routine returns.
   *
   * Returns 0 when the timer has expired otherwise -EINTR
   */
  int __sched schedule_hrtimeout(ktime_t *expires,
  			       const enum hrtimer_mode mode)
  {
  	return schedule_hrtimeout_range(expires, 0, mode);
  }
7bb67439b   Arjan van de Ven   select: Introduce...
1784
  EXPORT_SYMBOL_GPL(schedule_hrtimeout);