hrtimer.c 41 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712
  1. /*
  2. * linux/kernel/hrtimer.c
  3. *
  4. * Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
  5. * Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
  6. * Copyright(C) 2006-2007 Timesys Corp., Thomas Gleixner
  7. *
  8. * High-resolution kernel timers
  9. *
  10. * In contrast to the low-resolution timeout API implemented in
  11. * kernel/timer.c, hrtimers provide finer resolution and accuracy
  12. * depending on system configuration and capabilities.
  13. *
  14. * These timers are currently used for:
  15. * - itimers
  16. * - POSIX timers
  17. * - nanosleep
  18. * - precise in-kernel timing
  19. *
  20. * Started by: Thomas Gleixner and Ingo Molnar
  21. *
  22. * Credits:
  23. * based on kernel/timer.c
  24. *
  25. * Help, testing, suggestions, bugfixes, improvements were
  26. * provided by:
  27. *
  28. * George Anzinger, Andrew Morton, Steven Rostedt, Roman Zippel
  29. * et. al.
  30. *
  31. * For licencing details see kernel-base/COPYING
  32. */
  33. #include <linux/cpu.h>
  34. #include <linux/module.h>
  35. #include <linux/percpu.h>
  36. #include <linux/hrtimer.h>
  37. #include <linux/notifier.h>
  38. #include <linux/syscalls.h>
  39. #include <linux/kallsyms.h>
  40. #include <linux/interrupt.h>
  41. #include <linux/tick.h>
  42. #include <linux/seq_file.h>
  43. #include <linux/err.h>
  44. #include <linux/debugobjects.h>
  45. #include <asm/uaccess.h>
  46. /**
  47. * ktime_get - get the monotonic time in ktime_t format
  48. *
  49. * returns the time in ktime_t format
  50. */
  51. ktime_t ktime_get(void)
  52. {
  53. struct timespec now;
  54. ktime_get_ts(&now);
  55. return timespec_to_ktime(now);
  56. }
  57. EXPORT_SYMBOL_GPL(ktime_get);
  58. /**
  59. * ktime_get_real - get the real (wall-) time in ktime_t format
  60. *
  61. * returns the time in ktime_t format
  62. */
  63. ktime_t ktime_get_real(void)
  64. {
  65. struct timespec now;
  66. getnstimeofday(&now);
  67. return timespec_to_ktime(now);
  68. }
  69. EXPORT_SYMBOL_GPL(ktime_get_real);
  70. /*
  71. * The timer bases:
  72. *
  73. * Note: If we want to add new timer bases, we have to skip the two
  74. * clock ids captured by the cpu-timers. We do this by holding empty
  75. * entries rather than doing math adjustment of the clock ids.
  76. * This ensures that we capture erroneous accesses to these clock ids
  77. * rather than moving them into the range of valid clock id's.
  78. */
  79. DEFINE_PER_CPU(struct hrtimer_cpu_base, hrtimer_bases) =
  80. {
  81. .clock_base =
  82. {
  83. {
  84. .index = CLOCK_REALTIME,
  85. .get_time = &ktime_get_real,
  86. .resolution = KTIME_LOW_RES,
  87. },
  88. {
  89. .index = CLOCK_MONOTONIC,
  90. .get_time = &ktime_get,
  91. .resolution = KTIME_LOW_RES,
  92. },
  93. }
  94. };
  95. /**
  96. * ktime_get_ts - get the monotonic clock in timespec format
  97. * @ts: pointer to timespec variable
  98. *
  99. * The function calculates the monotonic clock from the realtime
  100. * clock and the wall_to_monotonic offset and stores the result
  101. * in normalized timespec format in the variable pointed to by @ts.
  102. */
  103. void ktime_get_ts(struct timespec *ts)
  104. {
  105. struct timespec tomono;
  106. unsigned long seq;
  107. do {
  108. seq = read_seqbegin(&xtime_lock);
  109. getnstimeofday(ts);
  110. tomono = wall_to_monotonic;
  111. } while (read_seqretry(&xtime_lock, seq));
  112. set_normalized_timespec(ts, ts->tv_sec + tomono.tv_sec,
  113. ts->tv_nsec + tomono.tv_nsec);
  114. }
  115. EXPORT_SYMBOL_GPL(ktime_get_ts);
  116. /*
  117. * Get the coarse grained time at the softirq based on xtime and
  118. * wall_to_monotonic.
  119. */
  120. static void hrtimer_get_softirq_time(struct hrtimer_cpu_base *base)
  121. {
  122. ktime_t xtim, tomono;
  123. struct timespec xts, tom;
  124. unsigned long seq;
  125. do {
  126. seq = read_seqbegin(&xtime_lock);
  127. xts = current_kernel_time();
  128. tom = wall_to_monotonic;
  129. } while (read_seqretry(&xtime_lock, seq));
  130. xtim = timespec_to_ktime(xts);
  131. tomono = timespec_to_ktime(tom);
  132. base->clock_base[CLOCK_REALTIME].softirq_time = xtim;
  133. base->clock_base[CLOCK_MONOTONIC].softirq_time =
  134. ktime_add(xtim, tomono);
  135. }
  136. /*
  137. * Functions and macros which are different for UP/SMP systems are kept in a
  138. * single place
  139. */
  140. #ifdef CONFIG_SMP
  141. /*
  142. * We are using hashed locking: holding per_cpu(hrtimer_bases)[n].lock
  143. * means that all timers which are tied to this base via timer->base are
  144. * locked, and the base itself is locked too.
  145. *
  146. * So __run_timers/migrate_timers can safely modify all timers which could
  147. * be found on the lists/queues.
  148. *
  149. * When the timer's base is locked, and the timer removed from list, it is
  150. * possible to set timer->base = NULL and drop the lock: the timer remains
  151. * locked.
  152. */
  153. static
  154. struct hrtimer_clock_base *lock_hrtimer_base(const struct hrtimer *timer,
  155. unsigned long *flags)
  156. {
  157. struct hrtimer_clock_base *base;
  158. for (;;) {
  159. base = timer->base;
  160. if (likely(base != NULL)) {
  161. spin_lock_irqsave(&base->cpu_base->lock, *flags);
  162. if (likely(base == timer->base))
  163. return base;
  164. /* The timer has migrated to another CPU: */
  165. spin_unlock_irqrestore(&base->cpu_base->lock, *flags);
  166. }
  167. cpu_relax();
  168. }
  169. }
  170. /*
  171. * Switch the timer base to the current CPU when possible.
  172. */
  173. static inline struct hrtimer_clock_base *
  174. switch_hrtimer_base(struct hrtimer *timer, struct hrtimer_clock_base *base)
  175. {
  176. struct hrtimer_clock_base *new_base;
  177. struct hrtimer_cpu_base *new_cpu_base;
  178. new_cpu_base = &__get_cpu_var(hrtimer_bases);
  179. new_base = &new_cpu_base->clock_base[base->index];
  180. if (base != new_base) {
  181. /*
  182. * We are trying to schedule the timer on the local CPU.
  183. * However we can't change timer's base while it is running,
  184. * so we keep it on the same CPU. No hassle vs. reprogramming
  185. * the event source in the high resolution case. The softirq
  186. * code will take care of this when the timer function has
  187. * completed. There is no conflict as we hold the lock until
  188. * the timer is enqueued.
  189. */
  190. if (unlikely(hrtimer_callback_running(timer)))
  191. return base;
  192. /* See the comment in lock_timer_base() */
  193. timer->base = NULL;
  194. spin_unlock(&base->cpu_base->lock);
  195. spin_lock(&new_base->cpu_base->lock);
  196. timer->base = new_base;
  197. }
  198. return new_base;
  199. }
  200. #else /* CONFIG_SMP */
  201. static inline struct hrtimer_clock_base *
  202. lock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
  203. {
  204. struct hrtimer_clock_base *base = timer->base;
  205. spin_lock_irqsave(&base->cpu_base->lock, *flags);
  206. return base;
  207. }
  208. # define switch_hrtimer_base(t, b) (b)
  209. #endif /* !CONFIG_SMP */
  210. /*
  211. * Functions for the union type storage format of ktime_t which are
  212. * too large for inlining:
  213. */
  214. #if BITS_PER_LONG < 64
  215. # ifndef CONFIG_KTIME_SCALAR
  216. /**
  217. * ktime_add_ns - Add a scalar nanoseconds value to a ktime_t variable
  218. * @kt: addend
  219. * @nsec: the scalar nsec value to add
  220. *
  221. * Returns the sum of kt and nsec in ktime_t format
  222. */
  223. ktime_t ktime_add_ns(const ktime_t kt, u64 nsec)
  224. {
  225. ktime_t tmp;
  226. if (likely(nsec < NSEC_PER_SEC)) {
  227. tmp.tv64 = nsec;
  228. } else {
  229. unsigned long rem = do_div(nsec, NSEC_PER_SEC);
  230. tmp = ktime_set((long)nsec, rem);
  231. }
  232. return ktime_add(kt, tmp);
  233. }
  234. EXPORT_SYMBOL_GPL(ktime_add_ns);
  235. /**
  236. * ktime_sub_ns - Subtract a scalar nanoseconds value from a ktime_t variable
  237. * @kt: minuend
  238. * @nsec: the scalar nsec value to subtract
  239. *
  240. * Returns the subtraction of @nsec from @kt in ktime_t format
  241. */
  242. ktime_t ktime_sub_ns(const ktime_t kt, u64 nsec)
  243. {
  244. ktime_t tmp;
  245. if (likely(nsec < NSEC_PER_SEC)) {
  246. tmp.tv64 = nsec;
  247. } else {
  248. unsigned long rem = do_div(nsec, NSEC_PER_SEC);
  249. tmp = ktime_set((long)nsec, rem);
  250. }
  251. return ktime_sub(kt, tmp);
  252. }
  253. EXPORT_SYMBOL_GPL(ktime_sub_ns);
  254. # endif /* !CONFIG_KTIME_SCALAR */
  255. /*
  256. * Divide a ktime value by a nanosecond value
  257. */
  258. u64 ktime_divns(const ktime_t kt, s64 div)
  259. {
  260. u64 dclc;
  261. int sft = 0;
  262. dclc = ktime_to_ns(kt);
  263. /* Make sure the divisor is less than 2^32: */
  264. while (div >> 32) {
  265. sft++;
  266. div >>= 1;
  267. }
  268. dclc >>= sft;
  269. do_div(dclc, (unsigned long) div);
  270. return dclc;
  271. }
  272. #endif /* BITS_PER_LONG >= 64 */
  273. /*
  274. * Add two ktime values and do a safety check for overflow:
  275. */
  276. ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs)
  277. {
  278. ktime_t res = ktime_add(lhs, rhs);
  279. /*
  280. * We use KTIME_SEC_MAX here, the maximum timeout which we can
  281. * return to user space in a timespec:
  282. */
  283. if (res.tv64 < 0 || res.tv64 < lhs.tv64 || res.tv64 < rhs.tv64)
  284. res = ktime_set(KTIME_SEC_MAX, 0);
  285. return res;
  286. }
  287. #ifdef CONFIG_DEBUG_OBJECTS_TIMERS
  288. static struct debug_obj_descr hrtimer_debug_descr;
  289. /*
  290. * fixup_init is called when:
  291. * - an active object is initialized
  292. */
  293. static int hrtimer_fixup_init(void *addr, enum debug_obj_state state)
  294. {
  295. struct hrtimer *timer = addr;
  296. switch (state) {
  297. case ODEBUG_STATE_ACTIVE:
  298. hrtimer_cancel(timer);
  299. debug_object_init(timer, &hrtimer_debug_descr);
  300. return 1;
  301. default:
  302. return 0;
  303. }
  304. }
  305. /*
  306. * fixup_activate is called when:
  307. * - an active object is activated
  308. * - an unknown object is activated (might be a statically initialized object)
  309. */
  310. static int hrtimer_fixup_activate(void *addr, enum debug_obj_state state)
  311. {
  312. switch (state) {
  313. case ODEBUG_STATE_NOTAVAILABLE:
  314. WARN_ON_ONCE(1);
  315. return 0;
  316. case ODEBUG_STATE_ACTIVE:
  317. WARN_ON(1);
  318. default:
  319. return 0;
  320. }
  321. }
  322. /*
  323. * fixup_free is called when:
  324. * - an active object is freed
  325. */
  326. static int hrtimer_fixup_free(void *addr, enum debug_obj_state state)
  327. {
  328. struct hrtimer *timer = addr;
  329. switch (state) {
  330. case ODEBUG_STATE_ACTIVE:
  331. hrtimer_cancel(timer);
  332. debug_object_free(timer, &hrtimer_debug_descr);
  333. return 1;
  334. default:
  335. return 0;
  336. }
  337. }
  338. static struct debug_obj_descr hrtimer_debug_descr = {
  339. .name = "hrtimer",
  340. .fixup_init = hrtimer_fixup_init,
  341. .fixup_activate = hrtimer_fixup_activate,
  342. .fixup_free = hrtimer_fixup_free,
  343. };
  344. static inline void debug_hrtimer_init(struct hrtimer *timer)
  345. {
  346. debug_object_init(timer, &hrtimer_debug_descr);
  347. }
  348. static inline void debug_hrtimer_activate(struct hrtimer *timer)
  349. {
  350. debug_object_activate(timer, &hrtimer_debug_descr);
  351. }
  352. static inline void debug_hrtimer_deactivate(struct hrtimer *timer)
  353. {
  354. debug_object_deactivate(timer, &hrtimer_debug_descr);
  355. }
  356. static inline void debug_hrtimer_free(struct hrtimer *timer)
  357. {
  358. debug_object_free(timer, &hrtimer_debug_descr);
  359. }
  360. static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  361. enum hrtimer_mode mode);
  362. void hrtimer_init_on_stack(struct hrtimer *timer, clockid_t clock_id,
  363. enum hrtimer_mode mode)
  364. {
  365. debug_object_init_on_stack(timer, &hrtimer_debug_descr);
  366. __hrtimer_init(timer, clock_id, mode);
  367. }
  368. void destroy_hrtimer_on_stack(struct hrtimer *timer)
  369. {
  370. debug_object_free(timer, &hrtimer_debug_descr);
  371. }
  372. #else
  373. static inline void debug_hrtimer_init(struct hrtimer *timer) { }
  374. static inline void debug_hrtimer_activate(struct hrtimer *timer) { }
  375. static inline void debug_hrtimer_deactivate(struct hrtimer *timer) { }
  376. #endif
  377. /* High resolution timer related functions */
  378. #ifdef CONFIG_HIGH_RES_TIMERS
  379. /*
  380. * High resolution timer enabled ?
  381. */
  382. static int hrtimer_hres_enabled __read_mostly = 1;
  383. /*
  384. * Enable / Disable high resolution mode
  385. */
  386. static int __init setup_hrtimer_hres(char *str)
  387. {
  388. if (!strcmp(str, "off"))
  389. hrtimer_hres_enabled = 0;
  390. else if (!strcmp(str, "on"))
  391. hrtimer_hres_enabled = 1;
  392. else
  393. return 0;
  394. return 1;
  395. }
  396. __setup("highres=", setup_hrtimer_hres);
  397. /*
  398. * hrtimer_high_res_enabled - query, if the highres mode is enabled
  399. */
  400. static inline int hrtimer_is_hres_enabled(void)
  401. {
  402. return hrtimer_hres_enabled;
  403. }
  404. /*
  405. * Is the high resolution mode active ?
  406. */
  407. static inline int hrtimer_hres_active(void)
  408. {
  409. return __get_cpu_var(hrtimer_bases).hres_active;
  410. }
  411. /*
  412. * Reprogram the event source with checking both queues for the
  413. * next event
  414. * Called with interrupts disabled and base->lock held
  415. */
  416. static void hrtimer_force_reprogram(struct hrtimer_cpu_base *cpu_base)
  417. {
  418. int i;
  419. struct hrtimer_clock_base *base = cpu_base->clock_base;
  420. ktime_t expires;
  421. cpu_base->expires_next.tv64 = KTIME_MAX;
  422. for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++, base++) {
  423. struct hrtimer *timer;
  424. if (!base->first)
  425. continue;
  426. timer = rb_entry(base->first, struct hrtimer, node);
  427. expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
  428. if (expires.tv64 < cpu_base->expires_next.tv64)
  429. cpu_base->expires_next = expires;
  430. }
  431. if (cpu_base->expires_next.tv64 != KTIME_MAX)
  432. tick_program_event(cpu_base->expires_next, 1);
  433. }
  434. /*
  435. * Shared reprogramming for clock_realtime and clock_monotonic
  436. *
  437. * When a timer is enqueued and expires earlier than the already enqueued
  438. * timers, we have to check, whether it expires earlier than the timer for
  439. * which the clock event device was armed.
  440. *
  441. * Called with interrupts disabled and base->cpu_base.lock held
  442. */
  443. static int hrtimer_reprogram(struct hrtimer *timer,
  444. struct hrtimer_clock_base *base)
  445. {
  446. ktime_t *expires_next = &__get_cpu_var(hrtimer_bases).expires_next;
  447. ktime_t expires = ktime_sub(hrtimer_get_expires(timer), base->offset);
  448. int res;
  449. WARN_ON_ONCE(hrtimer_get_expires_tv64(timer) < 0);
  450. /*
  451. * When the callback is running, we do not reprogram the clock event
  452. * device. The timer callback is either running on a different CPU or
  453. * the callback is executed in the hrtimer_interrupt context. The
  454. * reprogramming is handled either by the softirq, which called the
  455. * callback or at the end of the hrtimer_interrupt.
  456. */
  457. if (hrtimer_callback_running(timer))
  458. return 0;
  459. /*
  460. * CLOCK_REALTIME timer might be requested with an absolute
  461. * expiry time which is less than base->offset. Nothing wrong
  462. * about that, just avoid to call into the tick code, which
  463. * has now objections against negative expiry values.
  464. */
  465. if (expires.tv64 < 0)
  466. return -ETIME;
  467. if (expires.tv64 >= expires_next->tv64)
  468. return 0;
  469. /*
  470. * Clockevents returns -ETIME, when the event was in the past.
  471. */
  472. res = tick_program_event(expires, 0);
  473. if (!IS_ERR_VALUE(res))
  474. *expires_next = expires;
  475. return res;
  476. }
  477. /*
  478. * Retrigger next event is called after clock was set
  479. *
  480. * Called with interrupts disabled via on_each_cpu()
  481. */
  482. static void retrigger_next_event(void *arg)
  483. {
  484. struct hrtimer_cpu_base *base;
  485. struct timespec realtime_offset;
  486. unsigned long seq;
  487. if (!hrtimer_hres_active())
  488. return;
  489. do {
  490. seq = read_seqbegin(&xtime_lock);
  491. set_normalized_timespec(&realtime_offset,
  492. -wall_to_monotonic.tv_sec,
  493. -wall_to_monotonic.tv_nsec);
  494. } while (read_seqretry(&xtime_lock, seq));
  495. base = &__get_cpu_var(hrtimer_bases);
  496. /* Adjust CLOCK_REALTIME offset */
  497. spin_lock(&base->lock);
  498. base->clock_base[CLOCK_REALTIME].offset =
  499. timespec_to_ktime(realtime_offset);
  500. hrtimer_force_reprogram(base);
  501. spin_unlock(&base->lock);
  502. }
  503. /*
  504. * Clock realtime was set
  505. *
  506. * Change the offset of the realtime clock vs. the monotonic
  507. * clock.
  508. *
  509. * We might have to reprogram the high resolution timer interrupt. On
  510. * SMP we call the architecture specific code to retrigger _all_ high
  511. * resolution timer interrupts. On UP we just disable interrupts and
  512. * call the high resolution interrupt code.
  513. */
  514. void clock_was_set(void)
  515. {
  516. /* Retrigger the CPU local events everywhere */
  517. on_each_cpu(retrigger_next_event, NULL, 1);
  518. }
  519. /*
  520. * During resume we might have to reprogram the high resolution timer
  521. * interrupt (on the local CPU):
  522. */
  523. void hres_timers_resume(void)
  524. {
  525. WARN_ONCE(!irqs_disabled(),
  526. KERN_INFO "hres_timers_resume() called with IRQs enabled!");
  527. retrigger_next_event(NULL);
  528. }
  529. /*
  530. * Initialize the high resolution related parts of cpu_base
  531. */
  532. static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base)
  533. {
  534. base->expires_next.tv64 = KTIME_MAX;
  535. base->hres_active = 0;
  536. }
  537. /*
  538. * Initialize the high resolution related parts of a hrtimer
  539. */
  540. static inline void hrtimer_init_timer_hres(struct hrtimer *timer)
  541. {
  542. }
  543. /*
  544. * When High resolution timers are active, try to reprogram. Note, that in case
  545. * the state has HRTIMER_STATE_CALLBACK set, no reprogramming and no expiry
  546. * check happens. The timer gets enqueued into the rbtree. The reprogramming
  547. * and expiry check is done in the hrtimer_interrupt or in the softirq.
  548. */
  549. static inline int hrtimer_enqueue_reprogram(struct hrtimer *timer,
  550. struct hrtimer_clock_base *base)
  551. {
  552. if (base->cpu_base->hres_active && hrtimer_reprogram(timer, base)) {
  553. spin_unlock(&base->cpu_base->lock);
  554. raise_softirq_irqoff(HRTIMER_SOFTIRQ);
  555. spin_lock(&base->cpu_base->lock);
  556. return 1;
  557. }
  558. return 0;
  559. }
  560. /*
  561. * Switch to high resolution mode
  562. */
  563. static int hrtimer_switch_to_hres(void)
  564. {
  565. int cpu = smp_processor_id();
  566. struct hrtimer_cpu_base *base = &per_cpu(hrtimer_bases, cpu);
  567. unsigned long flags;
  568. if (base->hres_active)
  569. return 1;
  570. local_irq_save(flags);
  571. if (tick_init_highres()) {
  572. local_irq_restore(flags);
  573. printk(KERN_WARNING "Could not switch to high resolution "
  574. "mode on CPU %d\n", cpu);
  575. return 0;
  576. }
  577. base->hres_active = 1;
  578. base->clock_base[CLOCK_REALTIME].resolution = KTIME_HIGH_RES;
  579. base->clock_base[CLOCK_MONOTONIC].resolution = KTIME_HIGH_RES;
  580. tick_setup_sched_timer();
  581. /* "Retrigger" the interrupt to get things going */
  582. retrigger_next_event(NULL);
  583. local_irq_restore(flags);
  584. printk(KERN_DEBUG "Switched to high resolution mode on CPU %d\n",
  585. smp_processor_id());
  586. return 1;
  587. }
  588. #else
  589. static inline int hrtimer_hres_active(void) { return 0; }
  590. static inline int hrtimer_is_hres_enabled(void) { return 0; }
  591. static inline int hrtimer_switch_to_hres(void) { return 0; }
  592. static inline void hrtimer_force_reprogram(struct hrtimer_cpu_base *base) { }
  593. static inline int hrtimer_enqueue_reprogram(struct hrtimer *timer,
  594. struct hrtimer_clock_base *base)
  595. {
  596. return 0;
  597. }
  598. static inline void hrtimer_init_hres(struct hrtimer_cpu_base *base) { }
  599. static inline void hrtimer_init_timer_hres(struct hrtimer *timer) { }
  600. #endif /* CONFIG_HIGH_RES_TIMERS */
  601. #ifdef CONFIG_TIMER_STATS
  602. void __timer_stats_hrtimer_set_start_info(struct hrtimer *timer, void *addr)
  603. {
  604. if (timer->start_site)
  605. return;
  606. timer->start_site = addr;
  607. memcpy(timer->start_comm, current->comm, TASK_COMM_LEN);
  608. timer->start_pid = current->pid;
  609. }
  610. #endif
  611. /*
  612. * Counterpart to lock_hrtimer_base above:
  613. */
  614. static inline
  615. void unlock_hrtimer_base(const struct hrtimer *timer, unsigned long *flags)
  616. {
  617. spin_unlock_irqrestore(&timer->base->cpu_base->lock, *flags);
  618. }
  619. /**
  620. * hrtimer_forward - forward the timer expiry
  621. * @timer: hrtimer to forward
  622. * @now: forward past this time
  623. * @interval: the interval to forward
  624. *
  625. * Forward the timer expiry so it will expire in the future.
  626. * Returns the number of overruns.
  627. */
  628. u64 hrtimer_forward(struct hrtimer *timer, ktime_t now, ktime_t interval)
  629. {
  630. u64 orun = 1;
  631. ktime_t delta;
  632. delta = ktime_sub(now, hrtimer_get_expires(timer));
  633. if (delta.tv64 < 0)
  634. return 0;
  635. if (interval.tv64 < timer->base->resolution.tv64)
  636. interval.tv64 = timer->base->resolution.tv64;
  637. if (unlikely(delta.tv64 >= interval.tv64)) {
  638. s64 incr = ktime_to_ns(interval);
  639. orun = ktime_divns(delta, incr);
  640. hrtimer_add_expires_ns(timer, incr * orun);
  641. if (hrtimer_get_expires_tv64(timer) > now.tv64)
  642. return orun;
  643. /*
  644. * This (and the ktime_add() below) is the
  645. * correction for exact:
  646. */
  647. orun++;
  648. }
  649. hrtimer_add_expires(timer, interval);
  650. return orun;
  651. }
  652. EXPORT_SYMBOL_GPL(hrtimer_forward);
  653. /*
  654. * enqueue_hrtimer - internal function to (re)start a timer
  655. *
  656. * The timer is inserted in expiry order. Insertion into the
  657. * red black tree is O(log(n)). Must hold the base lock.
  658. *
  659. * Returns 1 when the new timer is the leftmost timer in the tree.
  660. */
  661. static int enqueue_hrtimer(struct hrtimer *timer,
  662. struct hrtimer_clock_base *base)
  663. {
  664. struct rb_node **link = &base->active.rb_node;
  665. struct rb_node *parent = NULL;
  666. struct hrtimer *entry;
  667. int leftmost = 1;
  668. debug_hrtimer_activate(timer);
  669. /*
  670. * Find the right place in the rbtree:
  671. */
  672. while (*link) {
  673. parent = *link;
  674. entry = rb_entry(parent, struct hrtimer, node);
  675. /*
  676. * We dont care about collisions. Nodes with
  677. * the same expiry time stay together.
  678. */
  679. if (hrtimer_get_expires_tv64(timer) <
  680. hrtimer_get_expires_tv64(entry)) {
  681. link = &(*link)->rb_left;
  682. } else {
  683. link = &(*link)->rb_right;
  684. leftmost = 0;
  685. }
  686. }
  687. /*
  688. * Insert the timer to the rbtree and check whether it
  689. * replaces the first pending timer
  690. */
  691. if (leftmost)
  692. base->first = &timer->node;
  693. rb_link_node(&timer->node, parent, link);
  694. rb_insert_color(&timer->node, &base->active);
  695. /*
  696. * HRTIMER_STATE_ENQUEUED is or'ed to the current state to preserve the
  697. * state of a possibly running callback.
  698. */
  699. timer->state |= HRTIMER_STATE_ENQUEUED;
  700. return leftmost;
  701. }
  702. /*
  703. * __remove_hrtimer - internal function to remove a timer
  704. *
  705. * Caller must hold the base lock.
  706. *
  707. * High resolution timer mode reprograms the clock event device when the
  708. * timer is the one which expires next. The caller can disable this by setting
  709. * reprogram to zero. This is useful, when the context does a reprogramming
  710. * anyway (e.g. timer interrupt)
  711. */
  712. static void __remove_hrtimer(struct hrtimer *timer,
  713. struct hrtimer_clock_base *base,
  714. unsigned long newstate, int reprogram)
  715. {
  716. if (timer->state & HRTIMER_STATE_ENQUEUED) {
  717. /*
  718. * Remove the timer from the rbtree and replace the
  719. * first entry pointer if necessary.
  720. */
  721. if (base->first == &timer->node) {
  722. base->first = rb_next(&timer->node);
  723. /* Reprogram the clock event device. if enabled */
  724. if (reprogram && hrtimer_hres_active())
  725. hrtimer_force_reprogram(base->cpu_base);
  726. }
  727. rb_erase(&timer->node, &base->active);
  728. }
  729. timer->state = newstate;
  730. }
  731. /*
  732. * remove hrtimer, called with base lock held
  733. */
  734. static inline int
  735. remove_hrtimer(struct hrtimer *timer, struct hrtimer_clock_base *base)
  736. {
  737. if (hrtimer_is_queued(timer)) {
  738. int reprogram;
  739. /*
  740. * Remove the timer and force reprogramming when high
  741. * resolution mode is active and the timer is on the current
  742. * CPU. If we remove a timer on another CPU, reprogramming is
  743. * skipped. The interrupt event on this CPU is fired and
  744. * reprogramming happens in the interrupt handler. This is a
  745. * rare case and less expensive than a smp call.
  746. */
  747. debug_hrtimer_deactivate(timer);
  748. timer_stats_hrtimer_clear_start_info(timer);
  749. reprogram = base->cpu_base == &__get_cpu_var(hrtimer_bases);
  750. __remove_hrtimer(timer, base, HRTIMER_STATE_INACTIVE,
  751. reprogram);
  752. return 1;
  753. }
  754. return 0;
  755. }
  756. /**
  757. * hrtimer_start_range_ns - (re)start an hrtimer on the current CPU
  758. * @timer: the timer to be added
  759. * @tim: expiry time
  760. * @delta_ns: "slack" range for the timer
  761. * @mode: expiry mode: absolute (HRTIMER_ABS) or relative (HRTIMER_REL)
  762. *
  763. * Returns:
  764. * 0 on success
  765. * 1 when the timer was active
  766. */
  767. int
  768. hrtimer_start_range_ns(struct hrtimer *timer, ktime_t tim, unsigned long delta_ns,
  769. const enum hrtimer_mode mode)
  770. {
  771. struct hrtimer_clock_base *base, *new_base;
  772. unsigned long flags;
  773. int ret, leftmost;
  774. base = lock_hrtimer_base(timer, &flags);
  775. /* Remove an active timer from the queue: */
  776. ret = remove_hrtimer(timer, base);
  777. /* Switch the timer base, if necessary: */
  778. new_base = switch_hrtimer_base(timer, base);
  779. if (mode == HRTIMER_MODE_REL) {
  780. tim = ktime_add_safe(tim, new_base->get_time());
  781. /*
  782. * CONFIG_TIME_LOW_RES is a temporary way for architectures
  783. * to signal that they simply return xtime in
  784. * do_gettimeoffset(). In this case we want to round up by
  785. * resolution when starting a relative timer, to avoid short
  786. * timeouts. This will go away with the GTOD framework.
  787. */
  788. #ifdef CONFIG_TIME_LOW_RES
  789. tim = ktime_add_safe(tim, base->resolution);
  790. #endif
  791. }
  792. hrtimer_set_expires_range_ns(timer, tim, delta_ns);
  793. timer_stats_hrtimer_set_start_info(timer);
  794. leftmost = enqueue_hrtimer(timer, new_base);
  795. /*
  796. * Only allow reprogramming if the new base is on this CPU.
  797. * (it might still be on another CPU if the timer was pending)
  798. *
  799. * XXX send_remote_softirq() ?
  800. */
  801. if (leftmost && new_base->cpu_base == &__get_cpu_var(hrtimer_bases))
  802. hrtimer_enqueue_reprogram(timer, new_base);
  803. unlock_hrtimer_base(timer, &flags);
  804. return ret;
  805. }
  806. EXPORT_SYMBOL_GPL(hrtimer_start_range_ns);
  807. /**
  808. * hrtimer_start - (re)start an hrtimer on the current CPU
  809. * @timer: the timer to be added
  810. * @tim: expiry time
  811. * @mode: expiry mode: absolute (HRTIMER_ABS) or relative (HRTIMER_REL)
  812. *
  813. * Returns:
  814. * 0 on success
  815. * 1 when the timer was active
  816. */
  817. int
  818. hrtimer_start(struct hrtimer *timer, ktime_t tim, const enum hrtimer_mode mode)
  819. {
  820. return hrtimer_start_range_ns(timer, tim, 0, mode);
  821. }
  822. EXPORT_SYMBOL_GPL(hrtimer_start);
  823. /**
  824. * hrtimer_try_to_cancel - try to deactivate a timer
  825. * @timer: hrtimer to stop
  826. *
  827. * Returns:
  828. * 0 when the timer was not active
  829. * 1 when the timer was active
  830. * -1 when the timer is currently excuting the callback function and
  831. * cannot be stopped
  832. */
  833. int hrtimer_try_to_cancel(struct hrtimer *timer)
  834. {
  835. struct hrtimer_clock_base *base;
  836. unsigned long flags;
  837. int ret = -1;
  838. base = lock_hrtimer_base(timer, &flags);
  839. if (!hrtimer_callback_running(timer))
  840. ret = remove_hrtimer(timer, base);
  841. unlock_hrtimer_base(timer, &flags);
  842. return ret;
  843. }
  844. EXPORT_SYMBOL_GPL(hrtimer_try_to_cancel);
  845. /**
  846. * hrtimer_cancel - cancel a timer and wait for the handler to finish.
  847. * @timer: the timer to be cancelled
  848. *
  849. * Returns:
  850. * 0 when the timer was not active
  851. * 1 when the timer was active
  852. */
  853. int hrtimer_cancel(struct hrtimer *timer)
  854. {
  855. for (;;) {
  856. int ret = hrtimer_try_to_cancel(timer);
  857. if (ret >= 0)
  858. return ret;
  859. cpu_relax();
  860. }
  861. }
  862. EXPORT_SYMBOL_GPL(hrtimer_cancel);
  863. /**
  864. * hrtimer_get_remaining - get remaining time for the timer
  865. * @timer: the timer to read
  866. */
  867. ktime_t hrtimer_get_remaining(const struct hrtimer *timer)
  868. {
  869. struct hrtimer_clock_base *base;
  870. unsigned long flags;
  871. ktime_t rem;
  872. base = lock_hrtimer_base(timer, &flags);
  873. rem = hrtimer_expires_remaining(timer);
  874. unlock_hrtimer_base(timer, &flags);
  875. return rem;
  876. }
  877. EXPORT_SYMBOL_GPL(hrtimer_get_remaining);
  878. #ifdef CONFIG_NO_HZ
  879. /**
  880. * hrtimer_get_next_event - get the time until next expiry event
  881. *
  882. * Returns the delta to the next expiry event or KTIME_MAX if no timer
  883. * is pending.
  884. */
  885. ktime_t hrtimer_get_next_event(void)
  886. {
  887. struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
  888. struct hrtimer_clock_base *base = cpu_base->clock_base;
  889. ktime_t delta, mindelta = { .tv64 = KTIME_MAX };
  890. unsigned long flags;
  891. int i;
  892. spin_lock_irqsave(&cpu_base->lock, flags);
  893. if (!hrtimer_hres_active()) {
  894. for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++, base++) {
  895. struct hrtimer *timer;
  896. if (!base->first)
  897. continue;
  898. timer = rb_entry(base->first, struct hrtimer, node);
  899. delta.tv64 = hrtimer_get_expires_tv64(timer);
  900. delta = ktime_sub(delta, base->get_time());
  901. if (delta.tv64 < mindelta.tv64)
  902. mindelta.tv64 = delta.tv64;
  903. }
  904. }
  905. spin_unlock_irqrestore(&cpu_base->lock, flags);
  906. if (mindelta.tv64 < 0)
  907. mindelta.tv64 = 0;
  908. return mindelta;
  909. }
  910. #endif
  911. static void __hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  912. enum hrtimer_mode mode)
  913. {
  914. struct hrtimer_cpu_base *cpu_base;
  915. memset(timer, 0, sizeof(struct hrtimer));
  916. cpu_base = &__raw_get_cpu_var(hrtimer_bases);
  917. if (clock_id == CLOCK_REALTIME && mode != HRTIMER_MODE_ABS)
  918. clock_id = CLOCK_MONOTONIC;
  919. timer->base = &cpu_base->clock_base[clock_id];
  920. INIT_LIST_HEAD(&timer->cb_entry);
  921. hrtimer_init_timer_hres(timer);
  922. #ifdef CONFIG_TIMER_STATS
  923. timer->start_site = NULL;
  924. timer->start_pid = -1;
  925. memset(timer->start_comm, 0, TASK_COMM_LEN);
  926. #endif
  927. }
  928. /**
  929. * hrtimer_init - initialize a timer to the given clock
  930. * @timer: the timer to be initialized
  931. * @clock_id: the clock to be used
  932. * @mode: timer mode abs/rel
  933. */
  934. void hrtimer_init(struct hrtimer *timer, clockid_t clock_id,
  935. enum hrtimer_mode mode)
  936. {
  937. debug_hrtimer_init(timer);
  938. __hrtimer_init(timer, clock_id, mode);
  939. }
  940. EXPORT_SYMBOL_GPL(hrtimer_init);
  941. /**
  942. * hrtimer_get_res - get the timer resolution for a clock
  943. * @which_clock: which clock to query
  944. * @tp: pointer to timespec variable to store the resolution
  945. *
  946. * Store the resolution of the clock selected by @which_clock in the
  947. * variable pointed to by @tp.
  948. */
  949. int hrtimer_get_res(const clockid_t which_clock, struct timespec *tp)
  950. {
  951. struct hrtimer_cpu_base *cpu_base;
  952. cpu_base = &__raw_get_cpu_var(hrtimer_bases);
  953. *tp = ktime_to_timespec(cpu_base->clock_base[which_clock].resolution);
  954. return 0;
  955. }
  956. EXPORT_SYMBOL_GPL(hrtimer_get_res);
  957. static void __run_hrtimer(struct hrtimer *timer)
  958. {
  959. struct hrtimer_clock_base *base = timer->base;
  960. struct hrtimer_cpu_base *cpu_base = base->cpu_base;
  961. enum hrtimer_restart (*fn)(struct hrtimer *);
  962. int restart;
  963. WARN_ON(!irqs_disabled());
  964. debug_hrtimer_deactivate(timer);
  965. __remove_hrtimer(timer, base, HRTIMER_STATE_CALLBACK, 0);
  966. timer_stats_account_hrtimer(timer);
  967. fn = timer->function;
  968. /*
  969. * Because we run timers from hardirq context, there is no chance
  970. * they get migrated to another cpu, therefore its safe to unlock
  971. * the timer base.
  972. */
  973. spin_unlock(&cpu_base->lock);
  974. restart = fn(timer);
  975. spin_lock(&cpu_base->lock);
  976. /*
  977. * Note: We clear the CALLBACK bit after enqueue_hrtimer and
  978. * we do not reprogramm the event hardware. Happens either in
  979. * hrtimer_start_range_ns() or in hrtimer_interrupt()
  980. */
  981. if (restart != HRTIMER_NORESTART) {
  982. BUG_ON(timer->state != HRTIMER_STATE_CALLBACK);
  983. enqueue_hrtimer(timer, base);
  984. }
  985. timer->state &= ~HRTIMER_STATE_CALLBACK;
  986. }
  987. #ifdef CONFIG_HIGH_RES_TIMERS
  988. /*
  989. * High resolution timer interrupt
  990. * Called with interrupts disabled
  991. */
  992. void hrtimer_interrupt(struct clock_event_device *dev)
  993. {
  994. struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
  995. struct hrtimer_clock_base *base;
  996. ktime_t expires_next, now;
  997. int i;
  998. BUG_ON(!cpu_base->hres_active);
  999. cpu_base->nr_events++;
  1000. dev->next_event.tv64 = KTIME_MAX;
  1001. retry:
  1002. now = ktime_get();
  1003. expires_next.tv64 = KTIME_MAX;
  1004. base = cpu_base->clock_base;
  1005. for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
  1006. ktime_t basenow;
  1007. struct rb_node *node;
  1008. spin_lock(&cpu_base->lock);
  1009. basenow = ktime_add(now, base->offset);
  1010. while ((node = base->first)) {
  1011. struct hrtimer *timer;
  1012. timer = rb_entry(node, struct hrtimer, node);
  1013. /*
  1014. * The immediate goal for using the softexpires is
  1015. * minimizing wakeups, not running timers at the
  1016. * earliest interrupt after their soft expiration.
  1017. * This allows us to avoid using a Priority Search
  1018. * Tree, which can answer a stabbing querry for
  1019. * overlapping intervals and instead use the simple
  1020. * BST we already have.
  1021. * We don't add extra wakeups by delaying timers that
  1022. * are right-of a not yet expired timer, because that
  1023. * timer will have to trigger a wakeup anyway.
  1024. */
  1025. if (basenow.tv64 < hrtimer_get_softexpires_tv64(timer)) {
  1026. ktime_t expires;
  1027. expires = ktime_sub(hrtimer_get_expires(timer),
  1028. base->offset);
  1029. if (expires.tv64 < expires_next.tv64)
  1030. expires_next = expires;
  1031. break;
  1032. }
  1033. __run_hrtimer(timer);
  1034. }
  1035. spin_unlock(&cpu_base->lock);
  1036. base++;
  1037. }
  1038. cpu_base->expires_next = expires_next;
  1039. /* Reprogramming necessary ? */
  1040. if (expires_next.tv64 != KTIME_MAX) {
  1041. if (tick_program_event(expires_next, 0))
  1042. goto retry;
  1043. }
  1044. }
  1045. /*
  1046. * local version of hrtimer_peek_ahead_timers() called with interrupts
  1047. * disabled.
  1048. */
  1049. static void __hrtimer_peek_ahead_timers(void)
  1050. {
  1051. struct tick_device *td;
  1052. if (!hrtimer_hres_active())
  1053. return;
  1054. td = &__get_cpu_var(tick_cpu_device);
  1055. if (td && td->evtdev)
  1056. hrtimer_interrupt(td->evtdev);
  1057. }
  1058. /**
  1059. * hrtimer_peek_ahead_timers -- run soft-expired timers now
  1060. *
  1061. * hrtimer_peek_ahead_timers will peek at the timer queue of
  1062. * the current cpu and check if there are any timers for which
  1063. * the soft expires time has passed. If any such timers exist,
  1064. * they are run immediately and then removed from the timer queue.
  1065. *
  1066. */
  1067. void hrtimer_peek_ahead_timers(void)
  1068. {
  1069. unsigned long flags;
  1070. local_irq_save(flags);
  1071. __hrtimer_peek_ahead_timers();
  1072. local_irq_restore(flags);
  1073. }
  1074. static void run_hrtimer_softirq(struct softirq_action *h)
  1075. {
  1076. hrtimer_peek_ahead_timers();
  1077. }
  1078. #else /* CONFIG_HIGH_RES_TIMERS */
  1079. static inline void __hrtimer_peek_ahead_timers(void) { }
  1080. #endif /* !CONFIG_HIGH_RES_TIMERS */
  1081. /*
  1082. * Called from timer softirq every jiffy, expire hrtimers:
  1083. *
  1084. * For HRT its the fall back code to run the softirq in the timer
  1085. * softirq context in case the hrtimer initialization failed or has
  1086. * not been done yet.
  1087. */
  1088. void hrtimer_run_pending(void)
  1089. {
  1090. if (hrtimer_hres_active())
  1091. return;
  1092. /*
  1093. * This _is_ ugly: We have to check in the softirq context,
  1094. * whether we can switch to highres and / or nohz mode. The
  1095. * clocksource switch happens in the timer interrupt with
  1096. * xtime_lock held. Notification from there only sets the
  1097. * check bit in the tick_oneshot code, otherwise we might
  1098. * deadlock vs. xtime_lock.
  1099. */
  1100. if (tick_check_oneshot_change(!hrtimer_is_hres_enabled()))
  1101. hrtimer_switch_to_hres();
  1102. }
  1103. /*
  1104. * Called from hardirq context every jiffy
  1105. */
  1106. void hrtimer_run_queues(void)
  1107. {
  1108. struct rb_node *node;
  1109. struct hrtimer_cpu_base *cpu_base = &__get_cpu_var(hrtimer_bases);
  1110. struct hrtimer_clock_base *base;
  1111. int index, gettime = 1;
  1112. if (hrtimer_hres_active())
  1113. return;
  1114. for (index = 0; index < HRTIMER_MAX_CLOCK_BASES; index++) {
  1115. base = &cpu_base->clock_base[index];
  1116. if (!base->first)
  1117. continue;
  1118. if (gettime) {
  1119. hrtimer_get_softirq_time(cpu_base);
  1120. gettime = 0;
  1121. }
  1122. spin_lock(&cpu_base->lock);
  1123. while ((node = base->first)) {
  1124. struct hrtimer *timer;
  1125. timer = rb_entry(node, struct hrtimer, node);
  1126. if (base->softirq_time.tv64 <=
  1127. hrtimer_get_expires_tv64(timer))
  1128. break;
  1129. __run_hrtimer(timer);
  1130. }
  1131. spin_unlock(&cpu_base->lock);
  1132. }
  1133. }
  1134. /*
  1135. * Sleep related functions:
  1136. */
  1137. static enum hrtimer_restart hrtimer_wakeup(struct hrtimer *timer)
  1138. {
  1139. struct hrtimer_sleeper *t =
  1140. container_of(timer, struct hrtimer_sleeper, timer);
  1141. struct task_struct *task = t->task;
  1142. t->task = NULL;
  1143. if (task)
  1144. wake_up_process(task);
  1145. return HRTIMER_NORESTART;
  1146. }
  1147. void hrtimer_init_sleeper(struct hrtimer_sleeper *sl, struct task_struct *task)
  1148. {
  1149. sl->timer.function = hrtimer_wakeup;
  1150. sl->task = task;
  1151. }
  1152. static int __sched do_nanosleep(struct hrtimer_sleeper *t, enum hrtimer_mode mode)
  1153. {
  1154. hrtimer_init_sleeper(t, current);
  1155. do {
  1156. set_current_state(TASK_INTERRUPTIBLE);
  1157. hrtimer_start_expires(&t->timer, mode);
  1158. if (!hrtimer_active(&t->timer))
  1159. t->task = NULL;
  1160. if (likely(t->task))
  1161. schedule();
  1162. hrtimer_cancel(&t->timer);
  1163. mode = HRTIMER_MODE_ABS;
  1164. } while (t->task && !signal_pending(current));
  1165. __set_current_state(TASK_RUNNING);
  1166. return t->task == NULL;
  1167. }
  1168. static int update_rmtp(struct hrtimer *timer, struct timespec __user *rmtp)
  1169. {
  1170. struct timespec rmt;
  1171. ktime_t rem;
  1172. rem = hrtimer_expires_remaining(timer);
  1173. if (rem.tv64 <= 0)
  1174. return 0;
  1175. rmt = ktime_to_timespec(rem);
  1176. if (copy_to_user(rmtp, &rmt, sizeof(*rmtp)))
  1177. return -EFAULT;
  1178. return 1;
  1179. }
  1180. long __sched hrtimer_nanosleep_restart(struct restart_block *restart)
  1181. {
  1182. struct hrtimer_sleeper t;
  1183. struct timespec __user *rmtp;
  1184. int ret = 0;
  1185. hrtimer_init_on_stack(&t.timer, restart->nanosleep.index,
  1186. HRTIMER_MODE_ABS);
  1187. hrtimer_set_expires_tv64(&t.timer, restart->nanosleep.expires);
  1188. if (do_nanosleep(&t, HRTIMER_MODE_ABS))
  1189. goto out;
  1190. rmtp = restart->nanosleep.rmtp;
  1191. if (rmtp) {
  1192. ret = update_rmtp(&t.timer, rmtp);
  1193. if (ret <= 0)
  1194. goto out;
  1195. }
  1196. /* The other values in restart are already filled in */
  1197. ret = -ERESTART_RESTARTBLOCK;
  1198. out:
  1199. destroy_hrtimer_on_stack(&t.timer);
  1200. return ret;
  1201. }
  1202. long hrtimer_nanosleep(struct timespec *rqtp, struct timespec __user *rmtp,
  1203. const enum hrtimer_mode mode, const clockid_t clockid)
  1204. {
  1205. struct restart_block *restart;
  1206. struct hrtimer_sleeper t;
  1207. int ret = 0;
  1208. unsigned long slack;
  1209. slack = current->timer_slack_ns;
  1210. if (rt_task(current))
  1211. slack = 0;
  1212. hrtimer_init_on_stack(&t.timer, clockid, mode);
  1213. hrtimer_set_expires_range_ns(&t.timer, timespec_to_ktime(*rqtp), slack);
  1214. if (do_nanosleep(&t, mode))
  1215. goto out;
  1216. /* Absolute timers do not update the rmtp value and restart: */
  1217. if (mode == HRTIMER_MODE_ABS) {
  1218. ret = -ERESTARTNOHAND;
  1219. goto out;
  1220. }
  1221. if (rmtp) {
  1222. ret = update_rmtp(&t.timer, rmtp);
  1223. if (ret <= 0)
  1224. goto out;
  1225. }
  1226. restart = &current_thread_info()->restart_block;
  1227. restart->fn = hrtimer_nanosleep_restart;
  1228. restart->nanosleep.index = t.timer.base->index;
  1229. restart->nanosleep.rmtp = rmtp;
  1230. restart->nanosleep.expires = hrtimer_get_expires_tv64(&t.timer);
  1231. ret = -ERESTART_RESTARTBLOCK;
  1232. out:
  1233. destroy_hrtimer_on_stack(&t.timer);
  1234. return ret;
  1235. }
  1236. SYSCALL_DEFINE2(nanosleep, struct timespec __user *, rqtp,
  1237. struct timespec __user *, rmtp)
  1238. {
  1239. struct timespec tu;
  1240. if (copy_from_user(&tu, rqtp, sizeof(tu)))
  1241. return -EFAULT;
  1242. if (!timespec_valid(&tu))
  1243. return -EINVAL;
  1244. return hrtimer_nanosleep(&tu, rmtp, HRTIMER_MODE_REL, CLOCK_MONOTONIC);
  1245. }
  1246. /*
  1247. * Functions related to boot-time initialization:
  1248. */
  1249. static void __cpuinit init_hrtimers_cpu(int cpu)
  1250. {
  1251. struct hrtimer_cpu_base *cpu_base = &per_cpu(hrtimer_bases, cpu);
  1252. int i;
  1253. spin_lock_init(&cpu_base->lock);
  1254. for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++)
  1255. cpu_base->clock_base[i].cpu_base = cpu_base;
  1256. hrtimer_init_hres(cpu_base);
  1257. }
  1258. #ifdef CONFIG_HOTPLUG_CPU
  1259. static void migrate_hrtimer_list(struct hrtimer_clock_base *old_base,
  1260. struct hrtimer_clock_base *new_base)
  1261. {
  1262. struct hrtimer *timer;
  1263. struct rb_node *node;
  1264. while ((node = rb_first(&old_base->active))) {
  1265. timer = rb_entry(node, struct hrtimer, node);
  1266. BUG_ON(hrtimer_callback_running(timer));
  1267. debug_hrtimer_deactivate(timer);
  1268. /*
  1269. * Mark it as STATE_MIGRATE not INACTIVE otherwise the
  1270. * timer could be seen as !active and just vanish away
  1271. * under us on another CPU
  1272. */
  1273. __remove_hrtimer(timer, old_base, HRTIMER_STATE_MIGRATE, 0);
  1274. timer->base = new_base;
  1275. /*
  1276. * Enqueue the timers on the new cpu. This does not
  1277. * reprogram the event device in case the timer
  1278. * expires before the earliest on this CPU, but we run
  1279. * hrtimer_interrupt after we migrated everything to
  1280. * sort out already expired timers and reprogram the
  1281. * event device.
  1282. */
  1283. enqueue_hrtimer(timer, new_base);
  1284. /* Clear the migration state bit */
  1285. timer->state &= ~HRTIMER_STATE_MIGRATE;
  1286. }
  1287. }
  1288. static void migrate_hrtimers(int scpu)
  1289. {
  1290. struct hrtimer_cpu_base *old_base, *new_base;
  1291. int i;
  1292. BUG_ON(cpu_online(scpu));
  1293. tick_cancel_sched_timer(scpu);
  1294. local_irq_disable();
  1295. old_base = &per_cpu(hrtimer_bases, scpu);
  1296. new_base = &__get_cpu_var(hrtimer_bases);
  1297. /*
  1298. * The caller is globally serialized and nobody else
  1299. * takes two locks at once, deadlock is not possible.
  1300. */
  1301. spin_lock(&new_base->lock);
  1302. spin_lock_nested(&old_base->lock, SINGLE_DEPTH_NESTING);
  1303. for (i = 0; i < HRTIMER_MAX_CLOCK_BASES; i++) {
  1304. migrate_hrtimer_list(&old_base->clock_base[i],
  1305. &new_base->clock_base[i]);
  1306. }
  1307. spin_unlock(&old_base->lock);
  1308. spin_unlock(&new_base->lock);
  1309. /* Check, if we got expired work to do */
  1310. __hrtimer_peek_ahead_timers();
  1311. local_irq_enable();
  1312. }
  1313. #endif /* CONFIG_HOTPLUG_CPU */
  1314. static int __cpuinit hrtimer_cpu_notify(struct notifier_block *self,
  1315. unsigned long action, void *hcpu)
  1316. {
  1317. int scpu = (long)hcpu;
  1318. switch (action) {
  1319. case CPU_UP_PREPARE:
  1320. case CPU_UP_PREPARE_FROZEN:
  1321. init_hrtimers_cpu(scpu);
  1322. break;
  1323. #ifdef CONFIG_HOTPLUG_CPU
  1324. case CPU_DEAD:
  1325. case CPU_DEAD_FROZEN:
  1326. {
  1327. clockevents_notify(CLOCK_EVT_NOTIFY_CPU_DEAD, &scpu);
  1328. migrate_hrtimers(scpu);
  1329. break;
  1330. }
  1331. #endif
  1332. default:
  1333. break;
  1334. }
  1335. return NOTIFY_OK;
  1336. }
  1337. static struct notifier_block __cpuinitdata hrtimers_nb = {
  1338. .notifier_call = hrtimer_cpu_notify,
  1339. };
  1340. void __init hrtimers_init(void)
  1341. {
  1342. hrtimer_cpu_notify(&hrtimers_nb, (unsigned long)CPU_UP_PREPARE,
  1343. (void *)(long)smp_processor_id());
  1344. register_cpu_notifier(&hrtimers_nb);
  1345. #ifdef CONFIG_HIGH_RES_TIMERS
  1346. open_softirq(HRTIMER_SOFTIRQ, run_hrtimer_softirq);
  1347. #endif
  1348. }
  1349. /**
  1350. * schedule_hrtimeout_range - sleep until timeout
  1351. * @expires: timeout value (ktime_t)
  1352. * @delta: slack in expires timeout (ktime_t)
  1353. * @mode: timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
  1354. *
  1355. * Make the current task sleep until the given expiry time has
  1356. * elapsed. The routine will return immediately unless
  1357. * the current task state has been set (see set_current_state()).
  1358. *
  1359. * The @delta argument gives the kernel the freedom to schedule the
  1360. * actual wakeup to a time that is both power and performance friendly.
  1361. * The kernel give the normal best effort behavior for "@expires+@delta",
  1362. * but may decide to fire the timer earlier, but no earlier than @expires.
  1363. *
  1364. * You can set the task state as follows -
  1365. *
  1366. * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
  1367. * pass before the routine returns.
  1368. *
  1369. * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
  1370. * delivered to the current task.
  1371. *
  1372. * The current task state is guaranteed to be TASK_RUNNING when this
  1373. * routine returns.
  1374. *
  1375. * Returns 0 when the timer has expired otherwise -EINTR
  1376. */
  1377. int __sched schedule_hrtimeout_range(ktime_t *expires, unsigned long delta,
  1378. const enum hrtimer_mode mode)
  1379. {
  1380. struct hrtimer_sleeper t;
  1381. /*
  1382. * Optimize when a zero timeout value is given. It does not
  1383. * matter whether this is an absolute or a relative time.
  1384. */
  1385. if (expires && !expires->tv64) {
  1386. __set_current_state(TASK_RUNNING);
  1387. return 0;
  1388. }
  1389. /*
  1390. * A NULL parameter means "inifinte"
  1391. */
  1392. if (!expires) {
  1393. schedule();
  1394. __set_current_state(TASK_RUNNING);
  1395. return -EINTR;
  1396. }
  1397. hrtimer_init_on_stack(&t.timer, CLOCK_MONOTONIC, mode);
  1398. hrtimer_set_expires_range_ns(&t.timer, *expires, delta);
  1399. hrtimer_init_sleeper(&t, current);
  1400. hrtimer_start_expires(&t.timer, mode);
  1401. if (!hrtimer_active(&t.timer))
  1402. t.task = NULL;
  1403. if (likely(t.task))
  1404. schedule();
  1405. hrtimer_cancel(&t.timer);
  1406. destroy_hrtimer_on_stack(&t.timer);
  1407. __set_current_state(TASK_RUNNING);
  1408. return !t.task ? 0 : -EINTR;
  1409. }
  1410. EXPORT_SYMBOL_GPL(schedule_hrtimeout_range);
  1411. /**
  1412. * schedule_hrtimeout - sleep until timeout
  1413. * @expires: timeout value (ktime_t)
  1414. * @mode: timer mode, HRTIMER_MODE_ABS or HRTIMER_MODE_REL
  1415. *
  1416. * Make the current task sleep until the given expiry time has
  1417. * elapsed. The routine will return immediately unless
  1418. * the current task state has been set (see set_current_state()).
  1419. *
  1420. * You can set the task state as follows -
  1421. *
  1422. * %TASK_UNINTERRUPTIBLE - at least @timeout time is guaranteed to
  1423. * pass before the routine returns.
  1424. *
  1425. * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
  1426. * delivered to the current task.
  1427. *
  1428. * The current task state is guaranteed to be TASK_RUNNING when this
  1429. * routine returns.
  1430. *
  1431. * Returns 0 when the timer has expired otherwise -EINTR
  1432. */
  1433. int __sched schedule_hrtimeout(ktime_t *expires,
  1434. const enum hrtimer_mode mode)
  1435. {
  1436. return schedule_hrtimeout_range(expires, 0, mode);
  1437. }
  1438. EXPORT_SYMBOL_GPL(schedule_hrtimeout);