clocksource.c 27.2 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
/*
 * linux/kernel/time/clocksource.c
 *
 * This file contains the functions which manage clocksource drivers.
 *
 * Copyright (C) 2004, 2005 IBM, John Stultz (johnstul@us.ibm.com)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * TODO WishList:
 *   o Allow clocksource drivers to be unregistered
 */

26
#include <linux/device.h>
27 28 29
#include <linux/clocksource.h>
#include <linux/init.h>
#include <linux/module.h>
30
#include <linux/sched.h> /* for spin_unlock_irq() using preempt_count() m68k */
31
#include <linux/tick.h>
32
#include <linux/kthread.h>
33

34
#include "tick-internal.h"
35
#include "timekeeping_internal.h"
36

37 38 39 40 41 42
/**
 * clocks_calc_mult_shift - calculate mult/shift factors for scaled math of clocks
 * @mult:	pointer to mult variable
 * @shift:	pointer to shift variable
 * @from:	frequency to convert from
 * @to:		frequency to convert to
43
 * @maxsec:	guaranteed runtime conversion range in seconds
44 45 46 47 48 49 50 51
 *
 * The function evaluates the shift/mult pair for the scaled math
 * operations of clocksources and clockevents.
 *
 * @to and @from are frequency values in HZ. For clock sources @to is
 * NSEC_PER_SEC == 1GHz and @from is the counter frequency. For clock
 * event @to is the counter frequency and @from is NSEC_PER_SEC.
 *
52
 * The @maxsec conversion range argument controls the time frame in
53 54 55 56 57 58 59 60
 * seconds which must be covered by the runtime conversion with the
 * calculated mult and shift factors. This guarantees that no 64bit
 * overflow happens when the input value of the conversion is
 * multiplied with the calculated mult factor. Larger ranges may
 * reduce the conversion accuracy by chosing smaller mult and shift
 * factors.
 */
void
61
clocks_calc_mult_shift(u32 *mult, u32 *shift, u32 from, u32 to, u32 maxsec)
62 63 64 65 66 67 68 69
{
	u64 tmp;
	u32 sft, sftacc= 32;

	/*
	 * Calculate the shift factor which is limiting the conversion
	 * range:
	 */
70
	tmp = ((u64)maxsec * from) >> 32;
71 72 73 74 75 76 77 78 79 80 81
	while (tmp) {
		tmp >>=1;
		sftacc--;
	}

	/*
	 * Find the conversion shift/mult pair which has the best
	 * accuracy and fits the maxsec conversion range:
	 */
	for (sft = 32; sft > 0; sft--) {
		tmp = (u64) to << sft;
82
		tmp += from / 2;
83 84 85 86 87 88 89 90
		do_div(tmp, from);
		if ((tmp >> sftacc) == 0)
			break;
	}
	*mult = tmp;
	*shift = sft;
}

91 92
/*[Clocksource internal variables]---------
 * curr_clocksource:
93
 *	currently selected clocksource.
94 95
 * clocksource_list:
 *	linked list with the registered clocksources
96 97
 * clocksource_mutex:
 *	protects manipulations to curr_clocksource and the clocksource_list
98 99 100
 * override_name:
 *	Name of the user-specified clocksource.
 */
101
static struct clocksource *curr_clocksource;
102
static LIST_HEAD(clocksource_list);
103
static DEFINE_MUTEX(clocksource_mutex);
104
static char override_name[CS_NAME_LEN];
105
static int finished_booting;
106

107
#ifdef CONFIG_CLOCKSOURCE_WATCHDOG
108
static void clocksource_watchdog_work(struct work_struct *work);
109
static void clocksource_select(void);
110

111 112 113
static LIST_HEAD(watchdog_list);
static struct clocksource *watchdog;
static struct timer_list watchdog_timer;
114
static DECLARE_WORK(watchdog_work, clocksource_watchdog_work);
115
static DEFINE_SPINLOCK(watchdog_lock);
116
static int watchdog_running;
117
static atomic_t watchdog_reset_pending;
T
Thomas Gleixner 已提交
118

119
static int clocksource_watchdog_kthread(void *data);
120
static void __clocksource_change_rating(struct clocksource *cs, int rating);
121

122
/*
123
 * Interval: 0.5sec Threshold: 0.0625s
124 125
 */
#define WATCHDOG_INTERVAL (HZ >> 1)
126
#define WATCHDOG_THRESHOLD (NSEC_PER_SEC >> 4)
127

128 129 130 131 132 133 134 135 136
static void clocksource_watchdog_work(struct work_struct *work)
{
	/*
	 * If kthread_run fails the next watchdog scan over the
	 * watchdog_list will find the unstable clock again.
	 */
	kthread_run(clocksource_watchdog_kthread, NULL, "kwatchdog");
}

137
static void __clocksource_unstable(struct clocksource *cs)
138 139
{
	cs->flags &= ~(CLOCK_SOURCE_VALID_FOR_HRES | CLOCK_SOURCE_WATCHDOG);
140
	cs->flags |= CLOCK_SOURCE_UNSTABLE;
141 142
	if (finished_booting)
		schedule_work(&watchdog_work);
143 144
}

145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173
static void clocksource_unstable(struct clocksource *cs, int64_t delta)
{
	printk(KERN_WARNING "Clocksource %s unstable (delta = %Ld ns)\n",
	       cs->name, delta);
	__clocksource_unstable(cs);
}

/**
 * clocksource_mark_unstable - mark clocksource unstable via watchdog
 * @cs:		clocksource to be marked unstable
 *
 * This function is called instead of clocksource_change_rating from
 * cpu hotplug code to avoid a deadlock between the clocksource mutex
 * and the cpu hotplug mutex. It defers the update of the clocksource
 * to the watchdog thread.
 */
void clocksource_mark_unstable(struct clocksource *cs)
{
	unsigned long flags;

	spin_lock_irqsave(&watchdog_lock, flags);
	if (!(cs->flags & CLOCK_SOURCE_UNSTABLE)) {
		if (list_empty(&cs->wd_list))
			list_add(&cs->wd_list, &watchdog_list);
		__clocksource_unstable(cs);
	}
	spin_unlock_irqrestore(&watchdog_lock, flags);
}

174 175
static void clocksource_watchdog(unsigned long data)
{
176
	struct clocksource *cs;
177
	cycle_t csnow, wdnow, delta;
178
	int64_t wd_nsec, cs_nsec;
179
	int next_cpu, reset_pending;
180 181

	spin_lock(&watchdog_lock);
182 183
	if (!watchdog_running)
		goto out;
184

185 186
	reset_pending = atomic_read(&watchdog_reset_pending);

187 188 189
	list_for_each_entry(cs, &watchdog_list, wd_list) {

		/* Clocksource already marked unstable? */
190
		if (cs->flags & CLOCK_SOURCE_UNSTABLE) {
191 192
			if (finished_booting)
				schedule_work(&watchdog_work);
193
			continue;
194
		}
195

196
		local_irq_disable();
197
		csnow = cs->read(cs);
198 199
		wdnow = watchdog->read(watchdog);
		local_irq_enable();
T
Thomas Gleixner 已提交
200

201
		/* Clocksource initialized ? */
202 203
		if (!(cs->flags & CLOCK_SOURCE_WATCHDOG) ||
		    atomic_read(&watchdog_reset_pending)) {
204
			cs->flags |= CLOCK_SOURCE_WATCHDOG;
205 206
			cs->wd_last = wdnow;
			cs->cs_last = csnow;
T
Thomas Gleixner 已提交
207 208 209
			continue;
		}

210 211 212
		delta = clocksource_delta(wdnow, cs->wd_last, watchdog->mask);
		wd_nsec = clocksource_cyc2ns(delta, watchdog->mult,
					     watchdog->shift);
213

214 215
		delta = clocksource_delta(csnow, cs->cs_last, cs->mask);
		cs_nsec = clocksource_cyc2ns(delta, cs->mult, cs->shift);
216 217 218
		cs->cs_last = csnow;
		cs->wd_last = wdnow;

219 220 221
		if (atomic_read(&watchdog_reset_pending))
			continue;

222
		/* Check the deviation from the watchdog clocksource. */
223
		if ((abs(cs_nsec - wd_nsec) > WATCHDOG_THRESHOLD)) {
224 225 226 227 228 229 230
			clocksource_unstable(cs, cs_nsec - wd_nsec);
			continue;
		}

		if (!(cs->flags & CLOCK_SOURCE_VALID_FOR_HRES) &&
		    (cs->flags & CLOCK_SOURCE_IS_CONTINUOUS) &&
		    (watchdog->flags & CLOCK_SOURCE_IS_CONTINUOUS)) {
231
			/* Mark it valid for high-res. */
232
			cs->flags |= CLOCK_SOURCE_VALID_FOR_HRES;
233 234 235 236 237 238 239 240

			/*
			 * clocksource_done_booting() will sort it if
			 * finished_booting is not set yet.
			 */
			if (!finished_booting)
				continue;

241
			/*
242 243 244 245 246 247
			 * If this is not the current clocksource let
			 * the watchdog thread reselect it. Due to the
			 * change to high res this clocksource might
			 * be preferred now. If it is the current
			 * clocksource let the tick code know about
			 * that change.
248
			 */
249 250 251 252 253 254
			if (cs != curr_clocksource) {
				cs->flags |= CLOCK_SOURCE_RESELECT;
				schedule_work(&watchdog_work);
			} else {
				tick_clock_notify();
			}
255 256 257
		}
	}

258 259 260 261 262 263 264
	/*
	 * We only clear the watchdog_reset_pending, when we did a
	 * full cycle through all clocksources.
	 */
	if (reset_pending)
		atomic_dec(&watchdog_reset_pending);

265 266 267 268 269 270 271 272 273
	/*
	 * Cycle through CPUs to check if the CPUs stay synchronized
	 * to each other.
	 */
	next_cpu = cpumask_next(raw_smp_processor_id(), cpu_online_mask);
	if (next_cpu >= nr_cpu_ids)
		next_cpu = cpumask_first(cpu_online_mask);
	watchdog_timer.expires += WATCHDOG_INTERVAL;
	add_timer_on(&watchdog_timer, next_cpu);
274
out:
275 276
	spin_unlock(&watchdog_lock);
}
277

278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296
static inline void clocksource_start_watchdog(void)
{
	if (watchdog_running || !watchdog || list_empty(&watchdog_list))
		return;
	init_timer(&watchdog_timer);
	watchdog_timer.function = clocksource_watchdog;
	watchdog_timer.expires = jiffies + WATCHDOG_INTERVAL;
	add_timer_on(&watchdog_timer, cpumask_first(cpu_online_mask));
	watchdog_running = 1;
}

static inline void clocksource_stop_watchdog(void)
{
	if (!watchdog_running || (watchdog && !list_empty(&watchdog_list)))
		return;
	del_timer(&watchdog_timer);
	watchdog_running = 0;
}

297 298 299 300 301 302 303 304
static inline void clocksource_reset_watchdog(void)
{
	struct clocksource *cs;

	list_for_each_entry(cs, &watchdog_list, wd_list)
		cs->flags &= ~CLOCK_SOURCE_WATCHDOG;
}

T
Thomas Gleixner 已提交
305 306
static void clocksource_resume_watchdog(void)
{
307
	atomic_inc(&watchdog_reset_pending);
T
Thomas Gleixner 已提交
308 309
}

310
static void clocksource_enqueue_watchdog(struct clocksource *cs)
311 312 313 314 315
{
	unsigned long flags;

	spin_lock_irqsave(&watchdog_lock, flags);
	if (cs->flags & CLOCK_SOURCE_MUST_VERIFY) {
316
		/* cs is a clocksource to be watched. */
317
		list_add(&cs->wd_list, &watchdog_list);
318
		cs->flags &= ~CLOCK_SOURCE_WATCHDOG;
319
	} else {
320
		/* cs is a watchdog. */
321
		if (cs->flags & CLOCK_SOURCE_IS_CONTINUOUS)
322
			cs->flags |= CLOCK_SOURCE_VALID_FOR_HRES;
323
		/* Pick the best watchdog. */
324 325 326
		if (!watchdog || cs->rating > watchdog->rating) {
			watchdog = cs;
			/* Reset watchdog cycles */
327
			clocksource_reset_watchdog();
328 329
		}
	}
330 331
	/* Check if the watchdog timer needs to be started. */
	clocksource_start_watchdog();
332 333
	spin_unlock_irqrestore(&watchdog_lock, flags);
}
334 335 336 337 338 339

static void clocksource_dequeue_watchdog(struct clocksource *cs)
{
	unsigned long flags;

	spin_lock_irqsave(&watchdog_lock, flags);
340 341 342 343 344 345
	if (cs != watchdog) {
		if (cs->flags & CLOCK_SOURCE_MUST_VERIFY) {
			/* cs is a watched clocksource. */
			list_del_init(&cs->wd_list);
			/* Check if the watchdog timer needs to be stopped. */
			clocksource_stop_watchdog();
346 347 348 349 350
		}
	}
	spin_unlock_irqrestore(&watchdog_lock, flags);
}

351
static int __clocksource_watchdog_kthread(void)
352 353 354
{
	struct clocksource *cs, *tmp;
	unsigned long flags;
355
	LIST_HEAD(unstable);
356
	int select = 0;
357 358

	spin_lock_irqsave(&watchdog_lock, flags);
359
	list_for_each_entry_safe(cs, tmp, &watchdog_list, wd_list) {
360 361
		if (cs->flags & CLOCK_SOURCE_UNSTABLE) {
			list_del_init(&cs->wd_list);
362
			list_add(&cs->wd_list, &unstable);
363 364 365 366 367
			select = 1;
		}
		if (cs->flags & CLOCK_SOURCE_RESELECT) {
			cs->flags &= ~CLOCK_SOURCE_RESELECT;
			select = 1;
368
		}
369
	}
370 371
	/* Check if the watchdog timer needs to be stopped. */
	clocksource_stop_watchdog();
372 373 374 375 376
	spin_unlock_irqrestore(&watchdog_lock, flags);

	/* Needs to be done outside of watchdog lock */
	list_for_each_entry_safe(cs, tmp, &unstable, wd_list) {
		list_del_init(&cs->wd_list);
377
		__clocksource_change_rating(cs, 0);
378
	}
379 380 381 382 383 384 385 386
	return select;
}

static int clocksource_watchdog_kthread(void *data)
{
	mutex_lock(&clocksource_mutex);
	if (__clocksource_watchdog_kthread())
		clocksource_select();
387
	mutex_unlock(&clocksource_mutex);
388
	return 0;
389 390
}

391 392 393 394 395
static bool clocksource_is_watchdog(struct clocksource *cs)
{
	return cs == watchdog;
}

396 397 398
#else /* CONFIG_CLOCKSOURCE_WATCHDOG */

static void clocksource_enqueue_watchdog(struct clocksource *cs)
399 400 401 402
{
	if (cs->flags & CLOCK_SOURCE_IS_CONTINUOUS)
		cs->flags |= CLOCK_SOURCE_VALID_FOR_HRES;
}
T
Thomas Gleixner 已提交
403

404
static inline void clocksource_dequeue_watchdog(struct clocksource *cs) { }
T
Thomas Gleixner 已提交
405
static inline void clocksource_resume_watchdog(void) { }
406
static inline int __clocksource_watchdog_kthread(void) { return 0; }
407
static bool clocksource_is_watchdog(struct clocksource *cs) { return false; }
408
void clocksource_mark_unstable(struct clocksource *cs) { }
409 410

#endif /* CONFIG_CLOCKSOURCE_WATCHDOG */
411

M
Magnus Damm 已提交
412 413 414 415 416 417 418 419 420 421 422 423
/**
 * clocksource_suspend - suspend the clocksource(s)
 */
void clocksource_suspend(void)
{
	struct clocksource *cs;

	list_for_each_entry_reverse(cs, &clocksource_list, list)
		if (cs->suspend)
			cs->suspend(cs);
}

T
Thomas Gleixner 已提交
424 425 426 427 428
/**
 * clocksource_resume - resume the clocksource(s)
 */
void clocksource_resume(void)
{
429
	struct clocksource *cs;
T
Thomas Gleixner 已提交
430

431
	list_for_each_entry(cs, &clocksource_list, list)
T
Thomas Gleixner 已提交
432
		if (cs->resume)
433
			cs->resume(cs);
T
Thomas Gleixner 已提交
434 435 436 437

	clocksource_resume_watchdog();
}

J
Jason Wessel 已提交
438 439 440 441
/**
 * clocksource_touch_watchdog - Update watchdog
 *
 * Update the watchdog after exception contexts such as kgdb so as not
442 443
 * to incorrectly trip the watchdog. This might fail when the kernel
 * was stopped in code which holds watchdog_lock.
J
Jason Wessel 已提交
444 445 446 447 448 449
 */
void clocksource_touch_watchdog(void)
{
	clocksource_resume_watchdog();
}

450 451 452 453 454 455 456 457 458
/**
 * clocksource_max_adjustment- Returns max adjustment amount
 * @cs:         Pointer to clocksource
 *
 */
static u32 clocksource_max_adjustment(struct clocksource *cs)
{
	u64 ret;
	/*
459
	 * We won't try to correct for more than 11% adjustments (110,000 ppm),
460 461 462 463 464 465
	 */
	ret = (u64)cs->mult * 11;
	do_div(ret,100);
	return (u32)ret;
}

466
/**
467 468 469 470 471
 * clocks_calc_max_nsecs - Returns maximum nanoseconds that can be converted
 * @mult:	cycle to nanosecond multiplier
 * @shift:	cycle to nanosecond divisor (power of two)
 * @maxadj:	maximum adjustment value to mult (~11%)
 * @mask:	bitmask for two's complement subtraction of non 64 bit counters
472 473
 * @max_cyc:	maximum cycle value before potential overflow (does not include
 *		any safety margin)
474 475 476
 *
 * NOTE: This function includes a safety margin of 50%, so that bad clock values
 * can be detected.
477
 */
478
u64 clocks_calc_max_nsecs(u32 mult, u32 shift, u32 maxadj, u64 mask, u64 *max_cyc)
479 480 481 482 483
{
	u64 max_nsecs, max_cycles;

	/*
	 * Calculate the maximum number of cycles that we can pass to the
484
	 * cyc2ns() function without overflowing a 64-bit result.
485
	 */
486 487
	max_cycles = ULLONG_MAX;
	do_div(max_cycles, mult+maxadj);
488 489 490

	/*
	 * The actual maximum number of cycles we can defer the clocksource is
491
	 * determined by the minimum of max_cycles and mask.
492 493
	 * Note: Here we subtract the maxadj to make sure we don't sleep for
	 * too long if there's a large negative adjustment.
494
	 */
495 496 497
	max_cycles = min(max_cycles, mask);
	max_nsecs = clocksource_cyc2ns(max_cycles, mult - maxadj, shift);

498 499 500 501
	/* return the max_cycles value as well if requested */
	if (max_cyc)
		*max_cyc = max_cycles;

502 503 504
	/* Return 50% of the actual maximum, so we can detect bad values */
	max_nsecs >>= 1;

505 506 507 508
	return max_nsecs;
}

/**
509 510
 * clocksource_update_max_deferment - Updates the clocksource max_idle_ns & max_cycles
 * @cs:         Pointer to clocksource to be updated
511 512
 *
 */
513
static inline void clocksource_update_max_deferment(struct clocksource *cs)
514
{
515 516 517
	cs->max_idle_ns = clocks_calc_max_nsecs(cs->mult, cs->shift,
						cs->maxadj, cs->mask,
						&cs->max_cycles);
518 519
}

J
John Stultz 已提交
520
#ifndef CONFIG_ARCH_USES_GETTIMEOFFSET
521

522
static struct clocksource *clocksource_find_best(bool oneshot, bool skipcur)
523 524 525 526 527 528 529 530 531 532 533 534
{
	struct clocksource *cs;

	if (!finished_booting || list_empty(&clocksource_list))
		return NULL;

	/*
	 * We pick the clocksource with the highest rating. If oneshot
	 * mode is active, we pick the highres valid clocksource with
	 * the best rating.
	 */
	list_for_each_entry(cs, &clocksource_list, list) {
535 536
		if (skipcur && cs == curr_clocksource)
			continue;
537 538 539 540 541 542 543
		if (oneshot && !(cs->flags & CLOCK_SOURCE_VALID_FOR_HRES))
			continue;
		return cs;
	}
	return NULL;
}

544
static void __clocksource_select(bool skipcur)
545
{
546
	bool oneshot = tick_oneshot_mode_active();
547
	struct clocksource *best, *cs;
548

549
	/* Find the best suitable clocksource */
550
	best = clocksource_find_best(oneshot, skipcur);
551
	if (!best)
552
		return;
553

554 555
	/* Check for the override clocksource. */
	list_for_each_entry(cs, &clocksource_list, list) {
556 557
		if (skipcur && cs == curr_clocksource)
			continue;
558 559 560 561 562 563 564
		if (strcmp(cs->name, override_name) != 0)
			continue;
		/*
		 * Check to make sure we don't switch to a non-highres
		 * capable clocksource if the tick code is in oneshot
		 * mode (highres or nohz)
		 */
565
		if (!(cs->flags & CLOCK_SOURCE_VALID_FOR_HRES) && oneshot) {
566 567 568 569 570 571 572 573 574 575
			/* Override clocksource cannot be used. */
			printk(KERN_WARNING "Override clocksource %s is not "
			       "HRT compatible. Cannot switch while in "
			       "HRT/NOHZ mode\n", cs->name);
			override_name[0] = 0;
		} else
			/* Override clocksource can be used. */
			best = cs;
		break;
	}
576 577 578

	if (curr_clocksource != best && !timekeeping_notify(best)) {
		pr_info("Switched to clocksource %s\n", best->name);
579 580
		curr_clocksource = best;
	}
581
}
582

583 584 585 586 587 588 589 590 591 592 593 594 595
/**
 * clocksource_select - Select the best clocksource available
 *
 * Private function. Must hold clocksource_mutex when called.
 *
 * Select the clocksource with the best rating, or the clocksource,
 * which is selected by userspace override.
 */
static void clocksource_select(void)
{
	return __clocksource_select(false);
}

596 597 598 599 600
static void clocksource_select_fallback(void)
{
	return __clocksource_select(true);
}

J
John Stultz 已提交
601
#else /* !CONFIG_ARCH_USES_GETTIMEOFFSET */
602 603

static inline void clocksource_select(void) { }
604
static inline void clocksource_select_fallback(void) { }
605 606 607

#endif

608 609 610 611 612 613 614 615 616
/*
 * clocksource_done_booting - Called near the end of core bootup
 *
 * Hack to avoid lots of clocksource churn at boot time.
 * We use fs_initcall because we want this to start before
 * device_initcall but after subsys_initcall.
 */
static int __init clocksource_done_booting(void)
{
617 618
	mutex_lock(&clocksource_mutex);
	curr_clocksource = clocksource_default_clock();
619
	finished_booting = 1;
620 621 622
	/*
	 * Run the watchdog first to eliminate unstable clock sources
	 */
623
	__clocksource_watchdog_kthread();
624
	clocksource_select();
625
	mutex_unlock(&clocksource_mutex);
626 627 628 629
	return 0;
}
fs_initcall(clocksource_done_booting);

630 631
/*
 * Enqueue the clocksource sorted by rating
632
 */
633
static void clocksource_enqueue(struct clocksource *cs)
634
{
635 636
	struct list_head *entry = &clocksource_list;
	struct clocksource *tmp;
637

638
	list_for_each_entry(tmp, &clocksource_list, list)
639
		/* Keep track of the place, where to insert */
640 641 642
		if (tmp->rating >= cs->rating)
			entry = &tmp->list;
	list_add(&cs->list, entry);
643 644
}

645
/**
646
 * __clocksource_updatefreq_scale - Used update clocksource with new freq
647
 * @cs:		clocksource to be registered
648 649 650
 * @scale:	Scale factor multiplied against freq to get clocksource hz
 * @freq:	clocksource frequency (cycles per second) divided by scale
 *
651
 * This should only be called from the clocksource->enable() method.
652 653
 *
 * This *SHOULD NOT* be called directly! Please use the
654
 * clocksource_updatefreq_hz() or clocksource_updatefreq_khz helper functions.
655
 */
656
void __clocksource_updatefreq_scale(struct clocksource *cs, u32 scale, u32 freq)
657
{
658
	u64 sec;
659
	/*
660 661 662 663 664 665
	 * Calc the maximum number of seconds which we can run before
	 * wrapping around. For clocksources which have a mask > 32bit
	 * we need to limit the max sleep time to have a good
	 * conversion precision. 10 minutes is still a reasonable
	 * amount. That results in a shift value of 24 for a
	 * clocksource with mask >= 40bit and f >= 4GHz. That maps to
666
	 * ~ 0.06ppm granularity for NTP.
667
	 */
668
	sec = cs->mask;
669 670 671 672 673 674 675
	do_div(sec, freq);
	do_div(sec, scale);
	if (!sec)
		sec = 1;
	else if (sec > 600 && cs->mask > UINT_MAX)
		sec = 600;

676
	clocks_calc_mult_shift(&cs->mult, &cs->shift, freq,
677
			       NSEC_PER_SEC / scale, sec * scale);
678 679

	/*
680 681
	 * Ensure clocksources that have large 'mult' values don't overflow
	 * when adjusted.
682 683 684 685 686 687 688 689 690
	 */
	cs->maxadj = clocksource_max_adjustment(cs);
	while ((cs->mult + cs->maxadj < cs->mult)
		|| (cs->mult - cs->maxadj > cs->mult)) {
		cs->mult >>= 1;
		cs->shift--;
		cs->maxadj = clocksource_max_adjustment(cs);
	}

691
	clocksource_update_max_deferment(cs);
692 693 694 695 696
}
EXPORT_SYMBOL_GPL(__clocksource_updatefreq_scale);

/**
 * __clocksource_register_scale - Used to install new clocksources
697
 * @cs:		clocksource to be registered
698 699 700 701 702 703 704 705 706 707 708
 * @scale:	Scale factor multiplied against freq to get clocksource hz
 * @freq:	clocksource frequency (cycles per second) divided by scale
 *
 * Returns -EBUSY if registration fails, zero otherwise.
 *
 * This *SHOULD NOT* be called directly! Please use the
 * clocksource_register_hz() or clocksource_register_khz helper functions.
 */
int __clocksource_register_scale(struct clocksource *cs, u32 scale, u32 freq)
{

709
	/* Initialize mult/shift and max_idle_ns */
710
	__clocksource_updatefreq_scale(cs, scale, freq);
711

712
	/* Add clocksource to the clocksource list */
713 714 715
	mutex_lock(&clocksource_mutex);
	clocksource_enqueue(cs);
	clocksource_enqueue_watchdog(cs);
716
	clocksource_select();
717 718 719 720 721 722
	mutex_unlock(&clocksource_mutex);
	return 0;
}
EXPORT_SYMBOL_GPL(__clocksource_register_scale);


723
/**
724
 * clocksource_register - Used to install new clocksources
725
 * @cs:		clocksource to be registered
726 727 728
 *
 * Returns -EBUSY if registration fails, zero otherwise.
 */
729
int clocksource_register(struct clocksource *cs)
730
{
731 732 733 734 735 736
	/* calculate max adjustment for given mult/shift */
	cs->maxadj = clocksource_max_adjustment(cs);
	WARN_ONCE(cs->mult + cs->maxadj < cs->mult,
		"Clocksource %s might overflow on 11%% adjustment\n",
		cs->name);

737 738
	/* Update max idle time permitted for this clocksource */
	clocksource_update_max_deferment(cs);
739

740
	mutex_lock(&clocksource_mutex);
741
	clocksource_enqueue(cs);
742
	clocksource_enqueue_watchdog(cs);
743
	clocksource_select();
744
	mutex_unlock(&clocksource_mutex);
745
	return 0;
746
}
747
EXPORT_SYMBOL(clocksource_register);
748

749 750 751 752 753 754 755
static void __clocksource_change_rating(struct clocksource *cs, int rating)
{
	list_del(&cs->list);
	cs->rating = rating;
	clocksource_enqueue(cs);
}

756
/**
757
 * clocksource_change_rating - Change the rating of a registered clocksource
758 759
 * @cs:		clocksource to be changed
 * @rating:	new rating
760
 */
761
void clocksource_change_rating(struct clocksource *cs, int rating)
762
{
763
	mutex_lock(&clocksource_mutex);
764
	__clocksource_change_rating(cs, rating);
765
	clocksource_select();
766
	mutex_unlock(&clocksource_mutex);
767
}
768
EXPORT_SYMBOL(clocksource_change_rating);
769

770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792
/*
 * Unbind clocksource @cs. Called with clocksource_mutex held
 */
static int clocksource_unbind(struct clocksource *cs)
{
	/*
	 * I really can't convince myself to support this on hardware
	 * designed by lobotomized monkeys.
	 */
	if (clocksource_is_watchdog(cs))
		return -EBUSY;

	if (cs == curr_clocksource) {
		/* Select and try to install a replacement clock source */
		clocksource_select_fallback();
		if (curr_clocksource == cs)
			return -EBUSY;
	}
	clocksource_dequeue_watchdog(cs);
	list_del_init(&cs->list);
	return 0;
}

793 794
/**
 * clocksource_unregister - remove a registered clocksource
795
 * @cs:	clocksource to be unregistered
796
 */
797
int clocksource_unregister(struct clocksource *cs)
798
{
799 800
	int ret = 0;

801
	mutex_lock(&clocksource_mutex);
802 803
	if (!list_empty(&cs->list))
		ret = clocksource_unbind(cs);
804
	mutex_unlock(&clocksource_mutex);
805
	return ret;
806
}
807
EXPORT_SYMBOL(clocksource_unregister);
808

809
#ifdef CONFIG_SYSFS
810 811 812
/**
 * sysfs_show_current_clocksources - sysfs interface for current clocksource
 * @dev:	unused
813
 * @attr:	unused
814 815 816 817 818
 * @buf:	char buffer to be filled with clocksource list
 *
 * Provides sysfs interface for listing current clocksource.
 */
static ssize_t
819 820
sysfs_show_current_clocksources(struct device *dev,
				struct device_attribute *attr, char *buf)
821
{
822
	ssize_t count = 0;
823

824
	mutex_lock(&clocksource_mutex);
825
	count = snprintf(buf, PAGE_SIZE, "%s\n", curr_clocksource->name);
826
	mutex_unlock(&clocksource_mutex);
827

828
	return count;
829 830
}

831
ssize_t sysfs_get_uname(const char *buf, char *dst, size_t cnt)
832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847
{
	size_t ret = cnt;

	/* strings from sysfs write are not 0 terminated! */
	if (!cnt || cnt >= CS_NAME_LEN)
		return -EINVAL;

	/* strip of \n: */
	if (buf[cnt-1] == '\n')
		cnt--;
	if (cnt > 0)
		memcpy(dst, buf, cnt);
	dst[cnt] = 0;
	return ret;
}

848 849 850
/**
 * sysfs_override_clocksource - interface for manually overriding clocksource
 * @dev:	unused
851
 * @attr:	unused
852 853 854 855
 * @buf:	name of override clocksource
 * @count:	length of buffer
 *
 * Takes input from sysfs interface for manually overriding the default
856
 * clocksource selection.
857
 */
858 859
static ssize_t sysfs_override_clocksource(struct device *dev,
					  struct device_attribute *attr,
860 861
					  const char *buf, size_t count)
{
862
	ssize_t ret;
863

864
	mutex_lock(&clocksource_mutex);
865

866
	ret = sysfs_get_uname(buf, override_name, count);
867 868
	if (ret >= 0)
		clocksource_select();
869

870
	mutex_unlock(&clocksource_mutex);
871 872 873 874

	return ret;
}

875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
/**
 * sysfs_unbind_current_clocksource - interface for manually unbinding clocksource
 * @dev:	unused
 * @attr:	unused
 * @buf:	unused
 * @count:	length of buffer
 *
 * Takes input from sysfs interface for manually unbinding a clocksource.
 */
static ssize_t sysfs_unbind_clocksource(struct device *dev,
					struct device_attribute *attr,
					const char *buf, size_t count)
{
	struct clocksource *cs;
	char name[CS_NAME_LEN];
890
	ssize_t ret;
891

892
	ret = sysfs_get_uname(buf, name, count);
893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908
	if (ret < 0)
		return ret;

	ret = -ENODEV;
	mutex_lock(&clocksource_mutex);
	list_for_each_entry(cs, &clocksource_list, list) {
		if (strcmp(cs->name, name))
			continue;
		ret = clocksource_unbind(cs);
		break;
	}
	mutex_unlock(&clocksource_mutex);

	return ret ? ret : count;
}

909 910 911
/**
 * sysfs_show_available_clocksources - sysfs interface for listing clocksource
 * @dev:	unused
912
 * @attr:	unused
913 914 915 916 917
 * @buf:	char buffer to be filled with clocksource list
 *
 * Provides sysfs interface for listing registered clocksources
 */
static ssize_t
918 919
sysfs_show_available_clocksources(struct device *dev,
				  struct device_attribute *attr,
920
				  char *buf)
921
{
922
	struct clocksource *src;
923
	ssize_t count = 0;
924

925
	mutex_lock(&clocksource_mutex);
926
	list_for_each_entry(src, &clocksource_list, list) {
927 928 929 930 931 932
		/*
		 * Don't show non-HRES clocksource if the tick code is
		 * in one shot mode (highres=on or nohz=on)
		 */
		if (!tick_oneshot_mode_active() ||
		    (src->flags & CLOCK_SOURCE_VALID_FOR_HRES))
933
			count += snprintf(buf + count,
934 935
				  max((ssize_t)PAGE_SIZE - count, (ssize_t)0),
				  "%s ", src->name);
936
	}
937
	mutex_unlock(&clocksource_mutex);
938

939 940
	count += snprintf(buf + count,
			  max((ssize_t)PAGE_SIZE - count, (ssize_t)0), "\n");
941

942
	return count;
943 944 945 946 947
}

/*
 * Sysfs setup bits:
 */
948
static DEVICE_ATTR(current_clocksource, 0644, sysfs_show_current_clocksources,
D
Daniel Walker 已提交
949
		   sysfs_override_clocksource);
950

951 952
static DEVICE_ATTR(unbind_clocksource, 0200, NULL, sysfs_unbind_clocksource);

953
static DEVICE_ATTR(available_clocksource, 0444,
D
Daniel Walker 已提交
954
		   sysfs_show_available_clocksources, NULL);
955

956
static struct bus_type clocksource_subsys = {
957
	.name = "clocksource",
958
	.dev_name = "clocksource",
959 960
};

961
static struct device device_clocksource = {
962
	.id	= 0,
963
	.bus	= &clocksource_subsys,
964 965
};

966
static int __init init_clocksource_sysfs(void)
967
{
968
	int error = subsys_system_register(&clocksource_subsys, NULL);
969 970

	if (!error)
971
		error = device_register(&device_clocksource);
972
	if (!error)
973
		error = device_create_file(
974
				&device_clocksource,
975
				&dev_attr_current_clocksource);
976 977 978
	if (!error)
		error = device_create_file(&device_clocksource,
					   &dev_attr_unbind_clocksource);
979
	if (!error)
980
		error = device_create_file(
981
				&device_clocksource,
982
				&dev_attr_available_clocksource);
983 984 985 986
	return error;
}

device_initcall(init_clocksource_sysfs);
987
#endif /* CONFIG_SYSFS */
988 989 990 991 992 993 994 995 996 997

/**
 * boot_override_clocksource - boot clock override
 * @str:	override name
 *
 * Takes a clocksource= boot argument and uses it
 * as the clocksource override name.
 */
static int __init boot_override_clocksource(char* str)
{
998
	mutex_lock(&clocksource_mutex);
999 1000
	if (str)
		strlcpy(override_name, str, sizeof(override_name));
1001
	mutex_unlock(&clocksource_mutex);
1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015
	return 1;
}

__setup("clocksource=", boot_override_clocksource);

/**
 * boot_override_clock - Compatibility layer for deprecated boot option
 * @str:	override name
 *
 * DEPRECATED! Takes a clock= boot argument and uses it
 * as the clocksource override name
 */
static int __init boot_override_clock(char* str)
{
1016 1017 1018 1019 1020 1021 1022
	if (!strcmp(str, "pmtmr")) {
		printk("Warning: clock=pmtmr is deprecated. "
			"Use clocksource=acpi_pm.\n");
		return boot_override_clocksource("acpi_pm");
	}
	printk("Warning! clock= boot option is deprecated. "
		"Use clocksource=xyz\n");
1023 1024 1025 1026
	return boot_override_clocksource(str);
}

__setup("clock=", boot_override_clock);