timer.c 43 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695
  1. /*
  2. * linux/kernel/timer.c
  3. *
  4. * Kernel internal timers, kernel timekeeping, basic process system calls
  5. *
  6. * Copyright (C) 1991, 1992 Linus Torvalds
  7. *
  8. * 1997-01-28 Modified by Finn Arne Gangstad to make timers scale better.
  9. *
  10. * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
  11. * "A Kernel Model for Precision Timekeeping" by Dave Mills
  12. * 1998-12-24 Fixed a xtime SMP race (we need the xtime_lock rw spinlock to
  13. * serialize accesses to xtime/lost_ticks).
  14. * Copyright (C) 1998 Andrea Arcangeli
  15. * 1999-03-10 Improved NTP compatibility by Ulrich Windl
  16. * 2002-05-31 Move sys_sysinfo here and make its locking sane, Robert Love
  17. * 2000-10-05 Implemented scalable SMP per-CPU timer handling.
  18. * Copyright (C) 2000, 2001, 2002 Ingo Molnar
  19. * Designed by David S. Miller, Alexey Kuznetsov and Ingo Molnar
  20. */
  21. #include <linux/kernel_stat.h>
  22. #include <linux/module.h>
  23. #include <linux/interrupt.h>
  24. #include <linux/percpu.h>
  25. #include <linux/init.h>
  26. #include <linux/mm.h>
  27. #include <linux/swap.h>
  28. #include <linux/notifier.h>
  29. #include <linux/thread_info.h>
  30. #include <linux/time.h>
  31. #include <linux/jiffies.h>
  32. #include <linux/posix-timers.h>
  33. #include <linux/cpu.h>
  34. #include <linux/syscalls.h>
  35. #include <linux/delay.h>
  36. #include <asm/uaccess.h>
  37. #include <asm/unistd.h>
  38. #include <asm/div64.h>
  39. #include <asm/timex.h>
  40. #include <asm/io.h>
  41. u64 jiffies_64 __cacheline_aligned_in_smp = INITIAL_JIFFIES;
  42. EXPORT_SYMBOL(jiffies_64);
  43. /*
  44. * per-CPU timer vector definitions:
  45. */
  46. #define TVN_BITS (CONFIG_BASE_SMALL ? 4 : 6)
  47. #define TVR_BITS (CONFIG_BASE_SMALL ? 6 : 8)
  48. #define TVN_SIZE (1 << TVN_BITS)
  49. #define TVR_SIZE (1 << TVR_BITS)
  50. #define TVN_MASK (TVN_SIZE - 1)
  51. #define TVR_MASK (TVR_SIZE - 1)
  52. typedef struct tvec_s {
  53. struct list_head vec[TVN_SIZE];
  54. } tvec_t;
  55. typedef struct tvec_root_s {
  56. struct list_head vec[TVR_SIZE];
  57. } tvec_root_t;
  58. struct tvec_t_base_s {
  59. spinlock_t lock;
  60. struct timer_list *running_timer;
  61. unsigned long timer_jiffies;
  62. tvec_root_t tv1;
  63. tvec_t tv2;
  64. tvec_t tv3;
  65. tvec_t tv4;
  66. tvec_t tv5;
  67. } ____cacheline_aligned_in_smp;
  68. typedef struct tvec_t_base_s tvec_base_t;
  69. tvec_base_t boot_tvec_bases;
  70. EXPORT_SYMBOL(boot_tvec_bases);
  71. static DEFINE_PER_CPU(tvec_base_t *, tvec_bases) = &boot_tvec_bases;
  72. static inline void set_running_timer(tvec_base_t *base,
  73. struct timer_list *timer)
  74. {
  75. #ifdef CONFIG_SMP
  76. base->running_timer = timer;
  77. #endif
  78. }
  79. static void internal_add_timer(tvec_base_t *base, struct timer_list *timer)
  80. {
  81. unsigned long expires = timer->expires;
  82. unsigned long idx = expires - base->timer_jiffies;
  83. struct list_head *vec;
  84. if (idx < TVR_SIZE) {
  85. int i = expires & TVR_MASK;
  86. vec = base->tv1.vec + i;
  87. } else if (idx < 1 << (TVR_BITS + TVN_BITS)) {
  88. int i = (expires >> TVR_BITS) & TVN_MASK;
  89. vec = base->tv2.vec + i;
  90. } else if (idx < 1 << (TVR_BITS + 2 * TVN_BITS)) {
  91. int i = (expires >> (TVR_BITS + TVN_BITS)) & TVN_MASK;
  92. vec = base->tv3.vec + i;
  93. } else if (idx < 1 << (TVR_BITS + 3 * TVN_BITS)) {
  94. int i = (expires >> (TVR_BITS + 2 * TVN_BITS)) & TVN_MASK;
  95. vec = base->tv4.vec + i;
  96. } else if ((signed long) idx < 0) {
  97. /*
  98. * Can happen if you add a timer with expires == jiffies,
  99. * or you set a timer to go off in the past
  100. */
  101. vec = base->tv1.vec + (base->timer_jiffies & TVR_MASK);
  102. } else {
  103. int i;
  104. /* If the timeout is larger than 0xffffffff on 64-bit
  105. * architectures then we use the maximum timeout:
  106. */
  107. if (idx > 0xffffffffUL) {
  108. idx = 0xffffffffUL;
  109. expires = idx + base->timer_jiffies;
  110. }
  111. i = (expires >> (TVR_BITS + 3 * TVN_BITS)) & TVN_MASK;
  112. vec = base->tv5.vec + i;
  113. }
  114. /*
  115. * Timers are FIFO:
  116. */
  117. list_add_tail(&timer->entry, vec);
  118. }
  119. /**
  120. * init_timer - initialize a timer.
  121. * @timer: the timer to be initialized
  122. *
  123. * init_timer() must be done to a timer prior calling *any* of the
  124. * other timer functions.
  125. */
  126. void fastcall init_timer(struct timer_list *timer)
  127. {
  128. timer->entry.next = NULL;
  129. timer->base = __raw_get_cpu_var(tvec_bases);
  130. }
  131. EXPORT_SYMBOL(init_timer);
  132. static inline void detach_timer(struct timer_list *timer,
  133. int clear_pending)
  134. {
  135. struct list_head *entry = &timer->entry;
  136. __list_del(entry->prev, entry->next);
  137. if (clear_pending)
  138. entry->next = NULL;
  139. entry->prev = LIST_POISON2;
  140. }
  141. /*
  142. * We are using hashed locking: holding per_cpu(tvec_bases).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 ->tvX lists.
  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 tvec_base_t *lock_timer_base(struct timer_list *timer,
  154. unsigned long *flags)
  155. __acquires(timer->base->lock)
  156. {
  157. tvec_base_t *base;
  158. for (;;) {
  159. base = timer->base;
  160. if (likely(base != NULL)) {
  161. spin_lock_irqsave(&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->lock, *flags);
  166. }
  167. cpu_relax();
  168. }
  169. }
  170. int __mod_timer(struct timer_list *timer, unsigned long expires)
  171. {
  172. tvec_base_t *base, *new_base;
  173. unsigned long flags;
  174. int ret = 0;
  175. BUG_ON(!timer->function);
  176. base = lock_timer_base(timer, &flags);
  177. if (timer_pending(timer)) {
  178. detach_timer(timer, 0);
  179. ret = 1;
  180. }
  181. new_base = __get_cpu_var(tvec_bases);
  182. if (base != new_base) {
  183. /*
  184. * We are trying to schedule the timer on the local CPU.
  185. * However we can't change timer's base while it is running,
  186. * otherwise del_timer_sync() can't detect that the timer's
  187. * handler yet has not finished. This also guarantees that
  188. * the timer is serialized wrt itself.
  189. */
  190. if (likely(base->running_timer != timer)) {
  191. /* See the comment in lock_timer_base() */
  192. timer->base = NULL;
  193. spin_unlock(&base->lock);
  194. base = new_base;
  195. spin_lock(&base->lock);
  196. timer->base = base;
  197. }
  198. }
  199. timer->expires = expires;
  200. internal_add_timer(base, timer);
  201. spin_unlock_irqrestore(&base->lock, flags);
  202. return ret;
  203. }
  204. EXPORT_SYMBOL(__mod_timer);
  205. /**
  206. * add_timer_on - start a timer on a particular CPU
  207. * @timer: the timer to be added
  208. * @cpu: the CPU to start it on
  209. *
  210. * This is not very scalable on SMP. Double adds are not possible.
  211. */
  212. void add_timer_on(struct timer_list *timer, int cpu)
  213. {
  214. tvec_base_t *base = per_cpu(tvec_bases, cpu);
  215. unsigned long flags;
  216. BUG_ON(timer_pending(timer) || !timer->function);
  217. spin_lock_irqsave(&base->lock, flags);
  218. timer->base = base;
  219. internal_add_timer(base, timer);
  220. spin_unlock_irqrestore(&base->lock, flags);
  221. }
  222. /**
  223. * mod_timer - modify a timer's timeout
  224. * @timer: the timer to be modified
  225. * @expires: new timeout in jiffies
  226. *
  227. * mod_timer is a more efficient way to update the expire field of an
  228. * active timer (if the timer is inactive it will be activated)
  229. *
  230. * mod_timer(timer, expires) is equivalent to:
  231. *
  232. * del_timer(timer); timer->expires = expires; add_timer(timer);
  233. *
  234. * Note that if there are multiple unserialized concurrent users of the
  235. * same timer, then mod_timer() is the only safe way to modify the timeout,
  236. * since add_timer() cannot modify an already running timer.
  237. *
  238. * The function returns whether it has modified a pending timer or not.
  239. * (ie. mod_timer() of an inactive timer returns 0, mod_timer() of an
  240. * active timer returns 1.)
  241. */
  242. int mod_timer(struct timer_list *timer, unsigned long expires)
  243. {
  244. BUG_ON(!timer->function);
  245. /*
  246. * This is a common optimization triggered by the
  247. * networking code - if the timer is re-modified
  248. * to be the same thing then just return:
  249. */
  250. if (timer->expires == expires && timer_pending(timer))
  251. return 1;
  252. return __mod_timer(timer, expires);
  253. }
  254. EXPORT_SYMBOL(mod_timer);
  255. /**
  256. * del_timer - deactive a timer.
  257. * @timer: the timer to be deactivated
  258. *
  259. * del_timer() deactivates a timer - this works on both active and inactive
  260. * timers.
  261. *
  262. * The function returns whether it has deactivated a pending timer or not.
  263. * (ie. del_timer() of an inactive timer returns 0, del_timer() of an
  264. * active timer returns 1.)
  265. */
  266. int del_timer(struct timer_list *timer)
  267. {
  268. tvec_base_t *base;
  269. unsigned long flags;
  270. int ret = 0;
  271. if (timer_pending(timer)) {
  272. base = lock_timer_base(timer, &flags);
  273. if (timer_pending(timer)) {
  274. detach_timer(timer, 1);
  275. ret = 1;
  276. }
  277. spin_unlock_irqrestore(&base->lock, flags);
  278. }
  279. return ret;
  280. }
  281. EXPORT_SYMBOL(del_timer);
  282. #ifdef CONFIG_SMP
  283. /**
  284. * try_to_del_timer_sync - Try to deactivate a timer
  285. * @timer: timer do del
  286. *
  287. * This function tries to deactivate a timer. Upon successful (ret >= 0)
  288. * exit the timer is not queued and the handler is not running on any CPU.
  289. *
  290. * It must not be called from interrupt contexts.
  291. */
  292. int try_to_del_timer_sync(struct timer_list *timer)
  293. {
  294. tvec_base_t *base;
  295. unsigned long flags;
  296. int ret = -1;
  297. base = lock_timer_base(timer, &flags);
  298. if (base->running_timer == timer)
  299. goto out;
  300. ret = 0;
  301. if (timer_pending(timer)) {
  302. detach_timer(timer, 1);
  303. ret = 1;
  304. }
  305. out:
  306. spin_unlock_irqrestore(&base->lock, flags);
  307. return ret;
  308. }
  309. /**
  310. * del_timer_sync - deactivate a timer and wait for the handler to finish.
  311. * @timer: the timer to be deactivated
  312. *
  313. * This function only differs from del_timer() on SMP: besides deactivating
  314. * the timer it also makes sure the handler has finished executing on other
  315. * CPUs.
  316. *
  317. * Synchronization rules: callers must prevent restarting of the timer,
  318. * otherwise this function is meaningless. It must not be called from
  319. * interrupt contexts. The caller must not hold locks which would prevent
  320. * completion of the timer's handler. The timer's handler must not call
  321. * add_timer_on(). Upon exit the timer is not queued and the handler is
  322. * not running on any CPU.
  323. *
  324. * The function returns whether it has deactivated a pending timer or not.
  325. */
  326. int del_timer_sync(struct timer_list *timer)
  327. {
  328. for (;;) {
  329. int ret = try_to_del_timer_sync(timer);
  330. if (ret >= 0)
  331. return ret;
  332. cpu_relax();
  333. }
  334. }
  335. EXPORT_SYMBOL(del_timer_sync);
  336. #endif
  337. static int cascade(tvec_base_t *base, tvec_t *tv, int index)
  338. {
  339. /* cascade all the timers from tv up one level */
  340. struct timer_list *timer, *tmp;
  341. struct list_head tv_list;
  342. list_replace_init(tv->vec + index, &tv_list);
  343. /*
  344. * We are removing _all_ timers from the list, so we
  345. * don't have to detach them individually.
  346. */
  347. list_for_each_entry_safe(timer, tmp, &tv_list, entry) {
  348. BUG_ON(timer->base != base);
  349. internal_add_timer(base, timer);
  350. }
  351. return index;
  352. }
  353. #define INDEX(N) ((base->timer_jiffies >> (TVR_BITS + (N) * TVN_BITS)) & TVN_MASK)
  354. /**
  355. * __run_timers - run all expired timers (if any) on this CPU.
  356. * @base: the timer vector to be processed.
  357. *
  358. * This function cascades all vectors and executes all expired timer
  359. * vectors.
  360. */
  361. static inline void __run_timers(tvec_base_t *base)
  362. {
  363. struct timer_list *timer;
  364. spin_lock_irq(&base->lock);
  365. while (time_after_eq(jiffies, base->timer_jiffies)) {
  366. struct list_head work_list;
  367. struct list_head *head = &work_list;
  368. int index = base->timer_jiffies & TVR_MASK;
  369. /*
  370. * Cascade timers:
  371. */
  372. if (!index &&
  373. (!cascade(base, &base->tv2, INDEX(0))) &&
  374. (!cascade(base, &base->tv3, INDEX(1))) &&
  375. !cascade(base, &base->tv4, INDEX(2)))
  376. cascade(base, &base->tv5, INDEX(3));
  377. ++base->timer_jiffies;
  378. list_replace_init(base->tv1.vec + index, &work_list);
  379. while (!list_empty(head)) {
  380. void (*fn)(unsigned long);
  381. unsigned long data;
  382. timer = list_entry(head->next,struct timer_list,entry);
  383. fn = timer->function;
  384. data = timer->data;
  385. set_running_timer(base, timer);
  386. detach_timer(timer, 1);
  387. spin_unlock_irq(&base->lock);
  388. {
  389. int preempt_count = preempt_count();
  390. fn(data);
  391. if (preempt_count != preempt_count()) {
  392. printk(KERN_WARNING "huh, entered %p "
  393. "with preempt_count %08x, exited"
  394. " with %08x?\n",
  395. fn, preempt_count,
  396. preempt_count());
  397. BUG();
  398. }
  399. }
  400. spin_lock_irq(&base->lock);
  401. }
  402. }
  403. set_running_timer(base, NULL);
  404. spin_unlock_irq(&base->lock);
  405. }
  406. #ifdef CONFIG_NO_IDLE_HZ
  407. /*
  408. * Find out when the next timer event is due to happen. This
  409. * is used on S/390 to stop all activity when a cpus is idle.
  410. * This functions needs to be called disabled.
  411. */
  412. unsigned long next_timer_interrupt(void)
  413. {
  414. tvec_base_t *base;
  415. struct list_head *list;
  416. struct timer_list *nte;
  417. unsigned long expires;
  418. unsigned long hr_expires = MAX_JIFFY_OFFSET;
  419. ktime_t hr_delta;
  420. tvec_t *varray[4];
  421. int i, j;
  422. hr_delta = hrtimer_get_next_event();
  423. if (hr_delta.tv64 != KTIME_MAX) {
  424. struct timespec tsdelta;
  425. tsdelta = ktime_to_timespec(hr_delta);
  426. hr_expires = timespec_to_jiffies(&tsdelta);
  427. if (hr_expires < 3)
  428. return hr_expires + jiffies;
  429. }
  430. hr_expires += jiffies;
  431. base = __get_cpu_var(tvec_bases);
  432. spin_lock(&base->lock);
  433. expires = base->timer_jiffies + (LONG_MAX >> 1);
  434. list = NULL;
  435. /* Look for timer events in tv1. */
  436. j = base->timer_jiffies & TVR_MASK;
  437. do {
  438. list_for_each_entry(nte, base->tv1.vec + j, entry) {
  439. expires = nte->expires;
  440. if (j < (base->timer_jiffies & TVR_MASK))
  441. list = base->tv2.vec + (INDEX(0));
  442. goto found;
  443. }
  444. j = (j + 1) & TVR_MASK;
  445. } while (j != (base->timer_jiffies & TVR_MASK));
  446. /* Check tv2-tv5. */
  447. varray[0] = &base->tv2;
  448. varray[1] = &base->tv3;
  449. varray[2] = &base->tv4;
  450. varray[3] = &base->tv5;
  451. for (i = 0; i < 4; i++) {
  452. j = INDEX(i);
  453. do {
  454. if (list_empty(varray[i]->vec + j)) {
  455. j = (j + 1) & TVN_MASK;
  456. continue;
  457. }
  458. list_for_each_entry(nte, varray[i]->vec + j, entry)
  459. if (time_before(nte->expires, expires))
  460. expires = nte->expires;
  461. if (j < (INDEX(i)) && i < 3)
  462. list = varray[i + 1]->vec + (INDEX(i + 1));
  463. goto found;
  464. } while (j != (INDEX(i)));
  465. }
  466. found:
  467. if (list) {
  468. /*
  469. * The search wrapped. We need to look at the next list
  470. * from next tv element that would cascade into tv element
  471. * where we found the timer element.
  472. */
  473. list_for_each_entry(nte, list, entry) {
  474. if (time_before(nte->expires, expires))
  475. expires = nte->expires;
  476. }
  477. }
  478. spin_unlock(&base->lock);
  479. /*
  480. * It can happen that other CPUs service timer IRQs and increment
  481. * jiffies, but we have not yet got a local timer tick to process
  482. * the timer wheels. In that case, the expiry time can be before
  483. * jiffies, but since the high-resolution timer here is relative to
  484. * jiffies, the default expression when high-resolution timers are
  485. * not active,
  486. *
  487. * time_before(MAX_JIFFY_OFFSET + jiffies, expires)
  488. *
  489. * would falsely evaluate to true. If that is the case, just
  490. * return jiffies so that we can immediately fire the local timer
  491. */
  492. if (time_before(expires, jiffies))
  493. return jiffies;
  494. if (time_before(hr_expires, expires))
  495. return hr_expires;
  496. return expires;
  497. }
  498. #endif
  499. /******************************************************************/
  500. /*
  501. * The current time
  502. * wall_to_monotonic is what we need to add to xtime (or xtime corrected
  503. * for sub jiffie times) to get to monotonic time. Monotonic is pegged
  504. * at zero at system boot time, so wall_to_monotonic will be negative,
  505. * however, we will ALWAYS keep the tv_nsec part positive so we can use
  506. * the usual normalization.
  507. */
  508. struct timespec xtime __attribute__ ((aligned (16)));
  509. struct timespec wall_to_monotonic __attribute__ ((aligned (16)));
  510. EXPORT_SYMBOL(xtime);
  511. /* XXX - all of this timekeeping code should be later moved to time.c */
  512. #include <linux/clocksource.h>
  513. static struct clocksource *clock; /* pointer to current clocksource */
  514. #ifdef CONFIG_GENERIC_TIME
  515. /**
  516. * __get_nsec_offset - Returns nanoseconds since last call to periodic_hook
  517. *
  518. * private function, must hold xtime_lock lock when being
  519. * called. Returns the number of nanoseconds since the
  520. * last call to update_wall_time() (adjusted by NTP scaling)
  521. */
  522. static inline s64 __get_nsec_offset(void)
  523. {
  524. cycle_t cycle_now, cycle_delta;
  525. s64 ns_offset;
  526. /* read clocksource: */
  527. cycle_now = clocksource_read(clock);
  528. /* calculate the delta since the last update_wall_time: */
  529. cycle_delta = (cycle_now - clock->cycle_last) & clock->mask;
  530. /* convert to nanoseconds: */
  531. ns_offset = cyc2ns(clock, cycle_delta);
  532. return ns_offset;
  533. }
  534. /**
  535. * __get_realtime_clock_ts - Returns the time of day in a timespec
  536. * @ts: pointer to the timespec to be set
  537. *
  538. * Returns the time of day in a timespec. Used by
  539. * do_gettimeofday() and get_realtime_clock_ts().
  540. */
  541. static inline void __get_realtime_clock_ts(struct timespec *ts)
  542. {
  543. unsigned long seq;
  544. s64 nsecs;
  545. do {
  546. seq = read_seqbegin(&xtime_lock);
  547. *ts = xtime;
  548. nsecs = __get_nsec_offset();
  549. } while (read_seqretry(&xtime_lock, seq));
  550. timespec_add_ns(ts, nsecs);
  551. }
  552. /**
  553. * getnstimeofday - Returns the time of day in a timespec
  554. * @ts: pointer to the timespec to be set
  555. *
  556. * Returns the time of day in a timespec.
  557. */
  558. void getnstimeofday(struct timespec *ts)
  559. {
  560. __get_realtime_clock_ts(ts);
  561. }
  562. EXPORT_SYMBOL(getnstimeofday);
  563. /**
  564. * do_gettimeofday - Returns the time of day in a timeval
  565. * @tv: pointer to the timeval to be set
  566. *
  567. * NOTE: Users should be converted to using get_realtime_clock_ts()
  568. */
  569. void do_gettimeofday(struct timeval *tv)
  570. {
  571. struct timespec now;
  572. __get_realtime_clock_ts(&now);
  573. tv->tv_sec = now.tv_sec;
  574. tv->tv_usec = now.tv_nsec/1000;
  575. }
  576. EXPORT_SYMBOL(do_gettimeofday);
  577. /**
  578. * do_settimeofday - Sets the time of day
  579. * @tv: pointer to the timespec variable containing the new time
  580. *
  581. * Sets the time of day to the new time and update NTP and notify hrtimers
  582. */
  583. int do_settimeofday(struct timespec *tv)
  584. {
  585. unsigned long flags;
  586. time_t wtm_sec, sec = tv->tv_sec;
  587. long wtm_nsec, nsec = tv->tv_nsec;
  588. if ((unsigned long)tv->tv_nsec >= NSEC_PER_SEC)
  589. return -EINVAL;
  590. write_seqlock_irqsave(&xtime_lock, flags);
  591. nsec -= __get_nsec_offset();
  592. wtm_sec = wall_to_monotonic.tv_sec + (xtime.tv_sec - sec);
  593. wtm_nsec = wall_to_monotonic.tv_nsec + (xtime.tv_nsec - nsec);
  594. set_normalized_timespec(&xtime, sec, nsec);
  595. set_normalized_timespec(&wall_to_monotonic, wtm_sec, wtm_nsec);
  596. clock->error = 0;
  597. ntp_clear();
  598. write_sequnlock_irqrestore(&xtime_lock, flags);
  599. /* signal hrtimers about time change */
  600. clock_was_set();
  601. return 0;
  602. }
  603. EXPORT_SYMBOL(do_settimeofday);
  604. /**
  605. * change_clocksource - Swaps clocksources if a new one is available
  606. *
  607. * Accumulates current time interval and initializes new clocksource
  608. */
  609. static int change_clocksource(void)
  610. {
  611. struct clocksource *new;
  612. cycle_t now;
  613. u64 nsec;
  614. new = clocksource_get_next();
  615. if (clock != new) {
  616. now = clocksource_read(new);
  617. nsec = __get_nsec_offset();
  618. timespec_add_ns(&xtime, nsec);
  619. clock = new;
  620. clock->cycle_last = now;
  621. printk(KERN_INFO "Time: %s clocksource has been installed.\n",
  622. clock->name);
  623. return 1;
  624. } else if (clock->update_callback) {
  625. return clock->update_callback();
  626. }
  627. return 0;
  628. }
  629. #else
  630. #define change_clocksource() (0)
  631. #endif
  632. /**
  633. * timeofday_is_continuous - check to see if timekeeping is free running
  634. */
  635. int timekeeping_is_continuous(void)
  636. {
  637. unsigned long seq;
  638. int ret;
  639. do {
  640. seq = read_seqbegin(&xtime_lock);
  641. ret = clock->is_continuous;
  642. } while (read_seqretry(&xtime_lock, seq));
  643. return ret;
  644. }
  645. /*
  646. * timekeeping_init - Initializes the clocksource and common timekeeping values
  647. */
  648. void __init timekeeping_init(void)
  649. {
  650. unsigned long flags;
  651. write_seqlock_irqsave(&xtime_lock, flags);
  652. ntp_clear();
  653. clock = clocksource_get_next();
  654. clocksource_calculate_interval(clock, tick_nsec);
  655. clock->cycle_last = clocksource_read(clock);
  656. write_sequnlock_irqrestore(&xtime_lock, flags);
  657. }
  658. static int timekeeping_suspended;
  659. /**
  660. * timekeeping_resume - Resumes the generic timekeeping subsystem.
  661. * @dev: unused
  662. *
  663. * This is for the generic clocksource timekeeping.
  664. * xtime/wall_to_monotonic/jiffies/etc are
  665. * still managed by arch specific suspend/resume code.
  666. */
  667. static int timekeeping_resume(struct sys_device *dev)
  668. {
  669. unsigned long flags;
  670. write_seqlock_irqsave(&xtime_lock, flags);
  671. /* restart the last cycle value */
  672. clock->cycle_last = clocksource_read(clock);
  673. clock->error = 0;
  674. timekeeping_suspended = 0;
  675. write_sequnlock_irqrestore(&xtime_lock, flags);
  676. return 0;
  677. }
  678. static int timekeeping_suspend(struct sys_device *dev, pm_message_t state)
  679. {
  680. unsigned long flags;
  681. write_seqlock_irqsave(&xtime_lock, flags);
  682. timekeeping_suspended = 1;
  683. write_sequnlock_irqrestore(&xtime_lock, flags);
  684. return 0;
  685. }
  686. /* sysfs resume/suspend bits for timekeeping */
  687. static struct sysdev_class timekeeping_sysclass = {
  688. .resume = timekeeping_resume,
  689. .suspend = timekeeping_suspend,
  690. set_kset_name("timekeeping"),
  691. };
  692. static struct sys_device device_timer = {
  693. .id = 0,
  694. .cls = &timekeeping_sysclass,
  695. };
  696. static int __init timekeeping_init_device(void)
  697. {
  698. int error = sysdev_class_register(&timekeeping_sysclass);
  699. if (!error)
  700. error = sysdev_register(&device_timer);
  701. return error;
  702. }
  703. device_initcall(timekeeping_init_device);
  704. /*
  705. * If the error is already larger, we look ahead even further
  706. * to compensate for late or lost adjustments.
  707. */
  708. static __always_inline int clocksource_bigadjust(s64 error, s64 *interval, s64 *offset)
  709. {
  710. s64 tick_error, i;
  711. u32 look_ahead, adj;
  712. s32 error2, mult;
  713. /*
  714. * Use the current error value to determine how much to look ahead.
  715. * The larger the error the slower we adjust for it to avoid problems
  716. * with losing too many ticks, otherwise we would overadjust and
  717. * produce an even larger error. The smaller the adjustment the
  718. * faster we try to adjust for it, as lost ticks can do less harm
  719. * here. This is tuned so that an error of about 1 msec is adusted
  720. * within about 1 sec (or 2^20 nsec in 2^SHIFT_HZ ticks).
  721. */
  722. error2 = clock->error >> (TICK_LENGTH_SHIFT + 22 - 2 * SHIFT_HZ);
  723. error2 = abs(error2);
  724. for (look_ahead = 0; error2 > 0; look_ahead++)
  725. error2 >>= 2;
  726. /*
  727. * Now calculate the error in (1 << look_ahead) ticks, but first
  728. * remove the single look ahead already included in the error.
  729. */
  730. tick_error = current_tick_length() >> (TICK_LENGTH_SHIFT - clock->shift + 1);
  731. tick_error -= clock->xtime_interval >> 1;
  732. error = ((error - tick_error) >> look_ahead) + tick_error;
  733. /* Finally calculate the adjustment shift value. */
  734. i = *interval;
  735. mult = 1;
  736. if (error < 0) {
  737. error = -error;
  738. *interval = -*interval;
  739. *offset = -*offset;
  740. mult = -1;
  741. }
  742. for (adj = 0; error > i; adj++)
  743. error >>= 1;
  744. *interval <<= adj;
  745. *offset <<= adj;
  746. return mult << adj;
  747. }
  748. /*
  749. * Adjust the multiplier to reduce the error value,
  750. * this is optimized for the most common adjustments of -1,0,1,
  751. * for other values we can do a bit more work.
  752. */
  753. static void clocksource_adjust(struct clocksource *clock, s64 offset)
  754. {
  755. s64 error, interval = clock->cycle_interval;
  756. int adj;
  757. error = clock->error >> (TICK_LENGTH_SHIFT - clock->shift - 1);
  758. if (error > interval) {
  759. error >>= 2;
  760. if (likely(error <= interval))
  761. adj = 1;
  762. else
  763. adj = clocksource_bigadjust(error, &interval, &offset);
  764. } else if (error < -interval) {
  765. error >>= 2;
  766. if (likely(error >= -interval)) {
  767. adj = -1;
  768. interval = -interval;
  769. offset = -offset;
  770. } else
  771. adj = clocksource_bigadjust(error, &interval, &offset);
  772. } else
  773. return;
  774. clock->mult += adj;
  775. clock->xtime_interval += interval;
  776. clock->xtime_nsec -= offset;
  777. clock->error -= (interval - offset) << (TICK_LENGTH_SHIFT - clock->shift);
  778. }
  779. /**
  780. * update_wall_time - Uses the current clocksource to increment the wall time
  781. *
  782. * Called from the timer interrupt, must hold a write on xtime_lock.
  783. */
  784. static void update_wall_time(void)
  785. {
  786. cycle_t offset;
  787. /* Make sure we're fully resumed: */
  788. if (unlikely(timekeeping_suspended))
  789. return;
  790. #ifdef CONFIG_GENERIC_TIME
  791. offset = (clocksource_read(clock) - clock->cycle_last) & clock->mask;
  792. #else
  793. offset = clock->cycle_interval;
  794. #endif
  795. clock->xtime_nsec += (s64)xtime.tv_nsec << clock->shift;
  796. /* normally this loop will run just once, however in the
  797. * case of lost or late ticks, it will accumulate correctly.
  798. */
  799. while (offset >= clock->cycle_interval) {
  800. /* accumulate one interval */
  801. clock->xtime_nsec += clock->xtime_interval;
  802. clock->cycle_last += clock->cycle_interval;
  803. offset -= clock->cycle_interval;
  804. if (clock->xtime_nsec >= (u64)NSEC_PER_SEC << clock->shift) {
  805. clock->xtime_nsec -= (u64)NSEC_PER_SEC << clock->shift;
  806. xtime.tv_sec++;
  807. second_overflow();
  808. }
  809. /* interpolator bits */
  810. time_interpolator_update(clock->xtime_interval
  811. >> clock->shift);
  812. /* accumulate error between NTP and clock interval */
  813. clock->error += current_tick_length();
  814. clock->error -= clock->xtime_interval << (TICK_LENGTH_SHIFT - clock->shift);
  815. }
  816. /* correct the clock when NTP error is too big */
  817. clocksource_adjust(clock, offset);
  818. /* store full nanoseconds into xtime */
  819. xtime.tv_nsec = (s64)clock->xtime_nsec >> clock->shift;
  820. clock->xtime_nsec -= (s64)xtime.tv_nsec << clock->shift;
  821. /* check to see if there is a new clocksource to use */
  822. if (change_clocksource()) {
  823. clock->error = 0;
  824. clock->xtime_nsec = 0;
  825. clocksource_calculate_interval(clock, tick_nsec);
  826. }
  827. }
  828. /*
  829. * Called from the timer interrupt handler to charge one tick to the current
  830. * process. user_tick is 1 if the tick is user time, 0 for system.
  831. */
  832. void update_process_times(int user_tick)
  833. {
  834. struct task_struct *p = current;
  835. int cpu = smp_processor_id();
  836. /* Note: this timer irq context must be accounted for as well. */
  837. if (user_tick)
  838. account_user_time(p, jiffies_to_cputime(1));
  839. else
  840. account_system_time(p, HARDIRQ_OFFSET, jiffies_to_cputime(1));
  841. run_local_timers();
  842. if (rcu_pending(cpu))
  843. rcu_check_callbacks(cpu, user_tick);
  844. scheduler_tick();
  845. run_posix_cpu_timers(p);
  846. }
  847. /*
  848. * Nr of active tasks - counted in fixed-point numbers
  849. */
  850. static unsigned long count_active_tasks(void)
  851. {
  852. return nr_active() * FIXED_1;
  853. }
  854. /*
  855. * Hmm.. Changed this, as the GNU make sources (load.c) seems to
  856. * imply that avenrun[] is the standard name for this kind of thing.
  857. * Nothing else seems to be standardized: the fractional size etc
  858. * all seem to differ on different machines.
  859. *
  860. * Requires xtime_lock to access.
  861. */
  862. unsigned long avenrun[3];
  863. EXPORT_SYMBOL(avenrun);
  864. /*
  865. * calc_load - given tick count, update the avenrun load estimates.
  866. * This is called while holding a write_lock on xtime_lock.
  867. */
  868. static inline void calc_load(unsigned long ticks)
  869. {
  870. unsigned long active_tasks; /* fixed-point */
  871. static int count = LOAD_FREQ;
  872. active_tasks = count_active_tasks();
  873. for (count -= ticks; count < 0; count += LOAD_FREQ) {
  874. CALC_LOAD(avenrun[0], EXP_1, active_tasks);
  875. CALC_LOAD(avenrun[1], EXP_5, active_tasks);
  876. CALC_LOAD(avenrun[2], EXP_15, active_tasks);
  877. }
  878. }
  879. /*
  880. * This read-write spinlock protects us from races in SMP while
  881. * playing with xtime and avenrun.
  882. */
  883. #ifndef ARCH_HAVE_XTIME_LOCK
  884. __cacheline_aligned_in_smp DEFINE_SEQLOCK(xtime_lock);
  885. EXPORT_SYMBOL(xtime_lock);
  886. #endif
  887. /*
  888. * This function runs timers and the timer-tq in bottom half context.
  889. */
  890. static void run_timer_softirq(struct softirq_action *h)
  891. {
  892. tvec_base_t *base = __get_cpu_var(tvec_bases);
  893. hrtimer_run_queues();
  894. if (time_after_eq(jiffies, base->timer_jiffies))
  895. __run_timers(base);
  896. }
  897. /*
  898. * Called by the local, per-CPU timer interrupt on SMP.
  899. */
  900. void run_local_timers(void)
  901. {
  902. raise_softirq(TIMER_SOFTIRQ);
  903. softlockup_tick();
  904. }
  905. /*
  906. * Called by the timer interrupt. xtime_lock must already be taken
  907. * by the timer IRQ!
  908. */
  909. static inline void update_times(unsigned long ticks)
  910. {
  911. update_wall_time();
  912. calc_load(ticks);
  913. }
  914. /*
  915. * The 64-bit jiffies value is not atomic - you MUST NOT read it
  916. * without sampling the sequence number in xtime_lock.
  917. * jiffies is defined in the linker script...
  918. */
  919. void do_timer(unsigned long ticks)
  920. {
  921. jiffies_64 += ticks;
  922. update_times(ticks);
  923. }
  924. #ifdef __ARCH_WANT_SYS_ALARM
  925. /*
  926. * For backwards compatibility? This can be done in libc so Alpha
  927. * and all newer ports shouldn't need it.
  928. */
  929. asmlinkage unsigned long sys_alarm(unsigned int seconds)
  930. {
  931. return alarm_setitimer(seconds);
  932. }
  933. #endif
  934. #ifndef __alpha__
  935. /*
  936. * The Alpha uses getxpid, getxuid, and getxgid instead. Maybe this
  937. * should be moved into arch/i386 instead?
  938. */
  939. /**
  940. * sys_getpid - return the thread group id of the current process
  941. *
  942. * Note, despite the name, this returns the tgid not the pid. The tgid and
  943. * the pid are identical unless CLONE_THREAD was specified on clone() in
  944. * which case the tgid is the same in all threads of the same group.
  945. *
  946. * This is SMP safe as current->tgid does not change.
  947. */
  948. asmlinkage long sys_getpid(void)
  949. {
  950. return current->tgid;
  951. }
  952. /*
  953. * Accessing ->real_parent is not SMP-safe, it could
  954. * change from under us. However, we can use a stale
  955. * value of ->real_parent under rcu_read_lock(), see
  956. * release_task()->call_rcu(delayed_put_task_struct).
  957. */
  958. asmlinkage long sys_getppid(void)
  959. {
  960. int pid;
  961. rcu_read_lock();
  962. pid = rcu_dereference(current->real_parent)->tgid;
  963. rcu_read_unlock();
  964. return pid;
  965. }
  966. asmlinkage long sys_getuid(void)
  967. {
  968. /* Only we change this so SMP safe */
  969. return current->uid;
  970. }
  971. asmlinkage long sys_geteuid(void)
  972. {
  973. /* Only we change this so SMP safe */
  974. return current->euid;
  975. }
  976. asmlinkage long sys_getgid(void)
  977. {
  978. /* Only we change this so SMP safe */
  979. return current->gid;
  980. }
  981. asmlinkage long sys_getegid(void)
  982. {
  983. /* Only we change this so SMP safe */
  984. return current->egid;
  985. }
  986. #endif
  987. static void process_timeout(unsigned long __data)
  988. {
  989. wake_up_process((struct task_struct *)__data);
  990. }
  991. /**
  992. * schedule_timeout - sleep until timeout
  993. * @timeout: timeout value in jiffies
  994. *
  995. * Make the current task sleep until @timeout jiffies have
  996. * elapsed. The routine will return immediately unless
  997. * the current task state has been set (see set_current_state()).
  998. *
  999. * You can set the task state as follows -
  1000. *
  1001. * %TASK_UNINTERRUPTIBLE - at least @timeout jiffies are guaranteed to
  1002. * pass before the routine returns. The routine will return 0
  1003. *
  1004. * %TASK_INTERRUPTIBLE - the routine may return early if a signal is
  1005. * delivered to the current task. In this case the remaining time
  1006. * in jiffies will be returned, or 0 if the timer expired in time
  1007. *
  1008. * The current task state is guaranteed to be TASK_RUNNING when this
  1009. * routine returns.
  1010. *
  1011. * Specifying a @timeout value of %MAX_SCHEDULE_TIMEOUT will schedule
  1012. * the CPU away without a bound on the timeout. In this case the return
  1013. * value will be %MAX_SCHEDULE_TIMEOUT.
  1014. *
  1015. * In all cases the return value is guaranteed to be non-negative.
  1016. */
  1017. fastcall signed long __sched schedule_timeout(signed long timeout)
  1018. {
  1019. struct timer_list timer;
  1020. unsigned long expire;
  1021. switch (timeout)
  1022. {
  1023. case MAX_SCHEDULE_TIMEOUT:
  1024. /*
  1025. * These two special cases are useful to be comfortable
  1026. * in the caller. Nothing more. We could take
  1027. * MAX_SCHEDULE_TIMEOUT from one of the negative value
  1028. * but I' d like to return a valid offset (>=0) to allow
  1029. * the caller to do everything it want with the retval.
  1030. */
  1031. schedule();
  1032. goto out;
  1033. default:
  1034. /*
  1035. * Another bit of PARANOID. Note that the retval will be
  1036. * 0 since no piece of kernel is supposed to do a check
  1037. * for a negative retval of schedule_timeout() (since it
  1038. * should never happens anyway). You just have the printk()
  1039. * that will tell you if something is gone wrong and where.
  1040. */
  1041. if (timeout < 0)
  1042. {
  1043. printk(KERN_ERR "schedule_timeout: wrong timeout "
  1044. "value %lx from %p\n", timeout,
  1045. __builtin_return_address(0));
  1046. current->state = TASK_RUNNING;
  1047. goto out;
  1048. }
  1049. }
  1050. expire = timeout + jiffies;
  1051. setup_timer(&timer, process_timeout, (unsigned long)current);
  1052. __mod_timer(&timer, expire);
  1053. schedule();
  1054. del_singleshot_timer_sync(&timer);
  1055. timeout = expire - jiffies;
  1056. out:
  1057. return timeout < 0 ? 0 : timeout;
  1058. }
  1059. EXPORT_SYMBOL(schedule_timeout);
  1060. /*
  1061. * We can use __set_current_state() here because schedule_timeout() calls
  1062. * schedule() unconditionally.
  1063. */
  1064. signed long __sched schedule_timeout_interruptible(signed long timeout)
  1065. {
  1066. __set_current_state(TASK_INTERRUPTIBLE);
  1067. return schedule_timeout(timeout);
  1068. }
  1069. EXPORT_SYMBOL(schedule_timeout_interruptible);
  1070. signed long __sched schedule_timeout_uninterruptible(signed long timeout)
  1071. {
  1072. __set_current_state(TASK_UNINTERRUPTIBLE);
  1073. return schedule_timeout(timeout);
  1074. }
  1075. EXPORT_SYMBOL(schedule_timeout_uninterruptible);
  1076. /* Thread ID - the internal kernel "pid" */
  1077. asmlinkage long sys_gettid(void)
  1078. {
  1079. return current->pid;
  1080. }
  1081. /**
  1082. * sys_sysinfo - fill in sysinfo struct
  1083. * @info: pointer to buffer to fill
  1084. */
  1085. asmlinkage long sys_sysinfo(struct sysinfo __user *info)
  1086. {
  1087. struct sysinfo val;
  1088. unsigned long mem_total, sav_total;
  1089. unsigned int mem_unit, bitcount;
  1090. unsigned long seq;
  1091. memset((char *)&val, 0, sizeof(struct sysinfo));
  1092. do {
  1093. struct timespec tp;
  1094. seq = read_seqbegin(&xtime_lock);
  1095. /*
  1096. * This is annoying. The below is the same thing
  1097. * posix_get_clock_monotonic() does, but it wants to
  1098. * take the lock which we want to cover the loads stuff
  1099. * too.
  1100. */
  1101. getnstimeofday(&tp);
  1102. tp.tv_sec += wall_to_monotonic.tv_sec;
  1103. tp.tv_nsec += wall_to_monotonic.tv_nsec;
  1104. if (tp.tv_nsec - NSEC_PER_SEC >= 0) {
  1105. tp.tv_nsec = tp.tv_nsec - NSEC_PER_SEC;
  1106. tp.tv_sec++;
  1107. }
  1108. val.uptime = tp.tv_sec + (tp.tv_nsec ? 1 : 0);
  1109. val.loads[0] = avenrun[0] << (SI_LOAD_SHIFT - FSHIFT);
  1110. val.loads[1] = avenrun[1] << (SI_LOAD_SHIFT - FSHIFT);
  1111. val.loads[2] = avenrun[2] << (SI_LOAD_SHIFT - FSHIFT);
  1112. val.procs = nr_threads;
  1113. } while (read_seqretry(&xtime_lock, seq));
  1114. si_meminfo(&val);
  1115. si_swapinfo(&val);
  1116. /*
  1117. * If the sum of all the available memory (i.e. ram + swap)
  1118. * is less than can be stored in a 32 bit unsigned long then
  1119. * we can be binary compatible with 2.2.x kernels. If not,
  1120. * well, in that case 2.2.x was broken anyways...
  1121. *
  1122. * -Erik Andersen <andersee@debian.org>
  1123. */
  1124. mem_total = val.totalram + val.totalswap;
  1125. if (mem_total < val.totalram || mem_total < val.totalswap)
  1126. goto out;
  1127. bitcount = 0;
  1128. mem_unit = val.mem_unit;
  1129. while (mem_unit > 1) {
  1130. bitcount++;
  1131. mem_unit >>= 1;
  1132. sav_total = mem_total;
  1133. mem_total <<= 1;
  1134. if (mem_total < sav_total)
  1135. goto out;
  1136. }
  1137. /*
  1138. * If mem_total did not overflow, multiply all memory values by
  1139. * val.mem_unit and set it to 1. This leaves things compatible
  1140. * with 2.2.x, and also retains compatibility with earlier 2.4.x
  1141. * kernels...
  1142. */
  1143. val.mem_unit = 1;
  1144. val.totalram <<= bitcount;
  1145. val.freeram <<= bitcount;
  1146. val.sharedram <<= bitcount;
  1147. val.bufferram <<= bitcount;
  1148. val.totalswap <<= bitcount;
  1149. val.freeswap <<= bitcount;
  1150. val.totalhigh <<= bitcount;
  1151. val.freehigh <<= bitcount;
  1152. out:
  1153. if (copy_to_user(info, &val, sizeof(struct sysinfo)))
  1154. return -EFAULT;
  1155. return 0;
  1156. }
  1157. /*
  1158. * lockdep: we want to track each per-CPU base as a separate lock-class,
  1159. * but timer-bases are kmalloc()-ed, so we need to attach separate
  1160. * keys to them:
  1161. */
  1162. static struct lock_class_key base_lock_keys[NR_CPUS];
  1163. static int __devinit init_timers_cpu(int cpu)
  1164. {
  1165. int j;
  1166. tvec_base_t *base;
  1167. static char __devinitdata tvec_base_done[NR_CPUS];
  1168. if (!tvec_base_done[cpu]) {
  1169. static char boot_done;
  1170. if (boot_done) {
  1171. /*
  1172. * The APs use this path later in boot
  1173. */
  1174. base = kmalloc_node(sizeof(*base), GFP_KERNEL,
  1175. cpu_to_node(cpu));
  1176. if (!base)
  1177. return -ENOMEM;
  1178. memset(base, 0, sizeof(*base));
  1179. per_cpu(tvec_bases, cpu) = base;
  1180. } else {
  1181. /*
  1182. * This is for the boot CPU - we use compile-time
  1183. * static initialisation because per-cpu memory isn't
  1184. * ready yet and because the memory allocators are not
  1185. * initialised either.
  1186. */
  1187. boot_done = 1;
  1188. base = &boot_tvec_bases;
  1189. }
  1190. tvec_base_done[cpu] = 1;
  1191. } else {
  1192. base = per_cpu(tvec_bases, cpu);
  1193. }
  1194. spin_lock_init(&base->lock);
  1195. lockdep_set_class(&base->lock, base_lock_keys + cpu);
  1196. for (j = 0; j < TVN_SIZE; j++) {
  1197. INIT_LIST_HEAD(base->tv5.vec + j);
  1198. INIT_LIST_HEAD(base->tv4.vec + j);
  1199. INIT_LIST_HEAD(base->tv3.vec + j);
  1200. INIT_LIST_HEAD(base->tv2.vec + j);
  1201. }
  1202. for (j = 0; j < TVR_SIZE; j++)
  1203. INIT_LIST_HEAD(base->tv1.vec + j);
  1204. base->timer_jiffies = jiffies;
  1205. return 0;
  1206. }
  1207. #ifdef CONFIG_HOTPLUG_CPU
  1208. static void migrate_timer_list(tvec_base_t *new_base, struct list_head *head)
  1209. {
  1210. struct timer_list *timer;
  1211. while (!list_empty(head)) {
  1212. timer = list_entry(head->next, struct timer_list, entry);
  1213. detach_timer(timer, 0);
  1214. timer->base = new_base;
  1215. internal_add_timer(new_base, timer);
  1216. }
  1217. }
  1218. static void __devinit migrate_timers(int cpu)
  1219. {
  1220. tvec_base_t *old_base;
  1221. tvec_base_t *new_base;
  1222. int i;
  1223. BUG_ON(cpu_online(cpu));
  1224. old_base = per_cpu(tvec_bases, cpu);
  1225. new_base = get_cpu_var(tvec_bases);
  1226. local_irq_disable();
  1227. spin_lock(&new_base->lock);
  1228. spin_lock(&old_base->lock);
  1229. BUG_ON(old_base->running_timer);
  1230. for (i = 0; i < TVR_SIZE; i++)
  1231. migrate_timer_list(new_base, old_base->tv1.vec + i);
  1232. for (i = 0; i < TVN_SIZE; i++) {
  1233. migrate_timer_list(new_base, old_base->tv2.vec + i);
  1234. migrate_timer_list(new_base, old_base->tv3.vec + i);
  1235. migrate_timer_list(new_base, old_base->tv4.vec + i);
  1236. migrate_timer_list(new_base, old_base->tv5.vec + i);
  1237. }
  1238. spin_unlock(&old_base->lock);
  1239. spin_unlock(&new_base->lock);
  1240. local_irq_enable();
  1241. put_cpu_var(tvec_bases);
  1242. }
  1243. #endif /* CONFIG_HOTPLUG_CPU */
  1244. static int __cpuinit timer_cpu_notify(struct notifier_block *self,
  1245. unsigned long action, void *hcpu)
  1246. {
  1247. long cpu = (long)hcpu;
  1248. switch(action) {
  1249. case CPU_UP_PREPARE:
  1250. if (init_timers_cpu(cpu) < 0)
  1251. return NOTIFY_BAD;
  1252. break;
  1253. #ifdef CONFIG_HOTPLUG_CPU
  1254. case CPU_DEAD:
  1255. migrate_timers(cpu);
  1256. break;
  1257. #endif
  1258. default:
  1259. break;
  1260. }
  1261. return NOTIFY_OK;
  1262. }
  1263. static struct notifier_block __cpuinitdata timers_nb = {
  1264. .notifier_call = timer_cpu_notify,
  1265. };
  1266. void __init init_timers(void)
  1267. {
  1268. int err = timer_cpu_notify(&timers_nb, (unsigned long)CPU_UP_PREPARE,
  1269. (void *)(long)smp_processor_id());
  1270. BUG_ON(err == NOTIFY_BAD);
  1271. register_cpu_notifier(&timers_nb);
  1272. open_softirq(TIMER_SOFTIRQ, run_timer_softirq, NULL);
  1273. }
  1274. #ifdef CONFIG_TIME_INTERPOLATION
  1275. struct time_interpolator *time_interpolator __read_mostly;
  1276. static struct time_interpolator *time_interpolator_list __read_mostly;
  1277. static DEFINE_SPINLOCK(time_interpolator_lock);
  1278. static inline u64 time_interpolator_get_cycles(unsigned int src)
  1279. {
  1280. unsigned long (*x)(void);
  1281. switch (src)
  1282. {
  1283. case TIME_SOURCE_FUNCTION:
  1284. x = time_interpolator->addr;
  1285. return x();
  1286. case TIME_SOURCE_MMIO64 :
  1287. return readq_relaxed((void __iomem *)time_interpolator->addr);
  1288. case TIME_SOURCE_MMIO32 :
  1289. return readl_relaxed((void __iomem *)time_interpolator->addr);
  1290. default: return get_cycles();
  1291. }
  1292. }
  1293. static inline u64 time_interpolator_get_counter(int writelock)
  1294. {
  1295. unsigned int src = time_interpolator->source;
  1296. if (time_interpolator->jitter)
  1297. {
  1298. u64 lcycle;
  1299. u64 now;
  1300. do {
  1301. lcycle = time_interpolator->last_cycle;
  1302. now = time_interpolator_get_cycles(src);
  1303. if (lcycle && time_after(lcycle, now))
  1304. return lcycle;
  1305. /* When holding the xtime write lock, there's no need
  1306. * to add the overhead of the cmpxchg. Readers are
  1307. * force to retry until the write lock is released.
  1308. */
  1309. if (writelock) {
  1310. time_interpolator->last_cycle = now;
  1311. return now;
  1312. }
  1313. /* Keep track of the last timer value returned. The use of cmpxchg here
  1314. * will cause contention in an SMP environment.
  1315. */
  1316. } while (unlikely(cmpxchg(&time_interpolator->last_cycle, lcycle, now) != lcycle));
  1317. return now;
  1318. }
  1319. else
  1320. return time_interpolator_get_cycles(src);
  1321. }
  1322. void time_interpolator_reset(void)
  1323. {
  1324. time_interpolator->offset = 0;
  1325. time_interpolator->last_counter = time_interpolator_get_counter(1);
  1326. }
  1327. #define GET_TI_NSECS(count,i) (((((count) - i->last_counter) & (i)->mask) * (i)->nsec_per_cyc) >> (i)->shift)
  1328. unsigned long time_interpolator_get_offset(void)
  1329. {
  1330. /* If we do not have a time interpolator set up then just return zero */
  1331. if (!time_interpolator)
  1332. return 0;
  1333. return time_interpolator->offset +
  1334. GET_TI_NSECS(time_interpolator_get_counter(0), time_interpolator);
  1335. }
  1336. #define INTERPOLATOR_ADJUST 65536
  1337. #define INTERPOLATOR_MAX_SKIP 10*INTERPOLATOR_ADJUST
  1338. void time_interpolator_update(long delta_nsec)
  1339. {
  1340. u64 counter;
  1341. unsigned long offset;
  1342. /* If there is no time interpolator set up then do nothing */
  1343. if (!time_interpolator)
  1344. return;
  1345. /*
  1346. * The interpolator compensates for late ticks by accumulating the late
  1347. * time in time_interpolator->offset. A tick earlier than expected will
  1348. * lead to a reset of the offset and a corresponding jump of the clock
  1349. * forward. Again this only works if the interpolator clock is running
  1350. * slightly slower than the regular clock and the tuning logic insures
  1351. * that.
  1352. */
  1353. counter = time_interpolator_get_counter(1);
  1354. offset = time_interpolator->offset +
  1355. GET_TI_NSECS(counter, time_interpolator);
  1356. if (delta_nsec < 0 || (unsigned long) delta_nsec < offset)
  1357. time_interpolator->offset = offset - delta_nsec;
  1358. else {
  1359. time_interpolator->skips++;
  1360. time_interpolator->ns_skipped += delta_nsec - offset;
  1361. time_interpolator->offset = 0;
  1362. }
  1363. time_interpolator->last_counter = counter;
  1364. /* Tuning logic for time interpolator invoked every minute or so.
  1365. * Decrease interpolator clock speed if no skips occurred and an offset is carried.
  1366. * Increase interpolator clock speed if we skip too much time.
  1367. */
  1368. if (jiffies % INTERPOLATOR_ADJUST == 0)
  1369. {
  1370. if (time_interpolator->skips == 0 && time_interpolator->offset > tick_nsec)
  1371. time_interpolator->nsec_per_cyc--;
  1372. if (time_interpolator->ns_skipped > INTERPOLATOR_MAX_SKIP && time_interpolator->offset == 0)
  1373. time_interpolator->nsec_per_cyc++;
  1374. time_interpolator->skips = 0;
  1375. time_interpolator->ns_skipped = 0;
  1376. }
  1377. }
  1378. static inline int
  1379. is_better_time_interpolator(struct time_interpolator *new)
  1380. {
  1381. if (!time_interpolator)
  1382. return 1;
  1383. return new->frequency > 2*time_interpolator->frequency ||
  1384. (unsigned long)new->drift < (unsigned long)time_interpolator->drift;
  1385. }
  1386. void
  1387. register_time_interpolator(struct time_interpolator *ti)
  1388. {
  1389. unsigned long flags;
  1390. /* Sanity check */
  1391. BUG_ON(ti->frequency == 0 || ti->mask == 0);
  1392. ti->nsec_per_cyc = ((u64)NSEC_PER_SEC << ti->shift) / ti->frequency;
  1393. spin_lock(&time_interpolator_lock);
  1394. write_seqlock_irqsave(&xtime_lock, flags);
  1395. if (is_better_time_interpolator(ti)) {
  1396. time_interpolator = ti;
  1397. time_interpolator_reset();
  1398. }
  1399. write_sequnlock_irqrestore(&xtime_lock, flags);
  1400. ti->next = time_interpolator_list;
  1401. time_interpolator_list = ti;
  1402. spin_unlock(&time_interpolator_lock);
  1403. }
  1404. void
  1405. unregister_time_interpolator(struct time_interpolator *ti)
  1406. {
  1407. struct time_interpolator *curr, **prev;
  1408. unsigned long flags;
  1409. spin_lock(&time_interpolator_lock);
  1410. prev = &time_interpolator_list;
  1411. for (curr = *prev; curr; curr = curr->next) {
  1412. if (curr == ti) {
  1413. *prev = curr->next;
  1414. break;
  1415. }
  1416. prev = &curr->next;
  1417. }
  1418. write_seqlock_irqsave(&xtime_lock, flags);
  1419. if (ti == time_interpolator) {
  1420. /* we lost the best time-interpolator: */
  1421. time_interpolator = NULL;
  1422. /* find the next-best interpolator */
  1423. for (curr = time_interpolator_list; curr; curr = curr->next)
  1424. if (is_better_time_interpolator(curr))
  1425. time_interpolator = curr;
  1426. time_interpolator_reset();
  1427. }
  1428. write_sequnlock_irqrestore(&xtime_lock, flags);
  1429. spin_unlock(&time_interpolator_lock);
  1430. }
  1431. #endif /* CONFIG_TIME_INTERPOLATION */
  1432. /**
  1433. * msleep - sleep safely even with waitqueue interruptions
  1434. * @msecs: Time in milliseconds to sleep for
  1435. */
  1436. void msleep(unsigned int msecs)
  1437. {
  1438. unsigned long timeout = msecs_to_jiffies(msecs) + 1;
  1439. while (timeout)
  1440. timeout = schedule_timeout_uninterruptible(timeout);
  1441. }
  1442. EXPORT_SYMBOL(msleep);
  1443. /**
  1444. * msleep_interruptible - sleep waiting for signals
  1445. * @msecs: Time in milliseconds to sleep for
  1446. */
  1447. unsigned long msleep_interruptible(unsigned int msecs)
  1448. {
  1449. unsigned long timeout = msecs_to_jiffies(msecs) + 1;
  1450. while (timeout && !signal_pending(current))
  1451. timeout = schedule_timeout_interruptible(timeout);
  1452. return jiffies_to_msecs(timeout);
  1453. }
  1454. EXPORT_SYMBOL(msleep_interruptible);