time.c 4.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 *  arch/sh/kernel/time.c
 *
 *  Copyright (C) 1999  Tetsuya Okada & Niibe Yutaka
 *  Copyright (C) 2000  Philipp Rumpf <prumpf@tux.org>
6
 *  Copyright (C) 2002, 2003, 2004, 2005  Paul Mundt
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14
 *  Copyright (C) 2002  M. R. Brown  <mrbrown@linux-sh.org>
 *
 *  Some code taken from i386 version.
 *    Copyright (C) 1991, 1992, 1995  Linus Torvalds
 */

#include <linux/config.h>
#include <linux/kernel.h>
15
#include <linux/module.h>
L
Linus Torvalds 已提交
16 17
#include <linux/init.h>
#include <linux/profile.h>
18
#include <asm/clock.h>
L
Linus Torvalds 已提交
19
#include <asm/rtc.h>
20
#include <asm/timer.h>
L
Linus Torvalds 已提交
21 22 23
#include <asm/kgdb.h>

extern unsigned long wall_jiffies;
24 25 26 27 28
struct sys_timer *sys_timer;

/* Move this somewhere more sensible.. */
DEFINE_SPINLOCK(rtc_lock);
EXPORT_SYMBOL(rtc_lock);
L
Linus Torvalds 已提交
29 30 31 32 33 34 35 36 37 38 39 40 41 42

/* XXX: Can we initialize this in a routine somewhere?  Dreamcast doesn't want
 * these routines anywhere... */
#ifdef CONFIG_SH_RTC
void (*rtc_get_time)(struct timespec *) = sh_rtc_gettimeofday;
int (*rtc_set_time)(const time_t) = sh_rtc_settimeofday;
#else
void (*rtc_get_time)(struct timespec *);
int (*rtc_set_time)(const time_t);
#endif

/*
 * Scheduler clock - returns current time in nanosec units.
 */
43
unsigned long long __attribute__ ((weak)) sched_clock(void)
L
Linus Torvalds 已提交
44 45 46 47 48 49 50 51 52 53 54 55
{
	return (unsigned long long)jiffies * (1000000000 / HZ);
}

void do_gettimeofday(struct timeval *tv)
{
	unsigned long seq;
	unsigned long usec, sec;
	unsigned long lost;

	do {
		seq = read_seqbegin(&xtime_lock);
56
		usec = get_timer_offset();
L
Linus Torvalds 已提交
57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91

		lost = jiffies - wall_jiffies;
		if (lost)
			usec += lost * (1000000 / HZ);

		sec = xtime.tv_sec;
		usec += xtime.tv_nsec / 1000;
	} while (read_seqretry(&xtime_lock, seq));

	while (usec >= 1000000) {
		usec -= 1000000;
		sec++;
	}

	tv->tv_sec = sec;
	tv->tv_usec = usec;
}

EXPORT_SYMBOL(do_gettimeofday);

int do_settimeofday(struct timespec *tv)
{
	time_t wtm_sec, sec = tv->tv_sec;
	long wtm_nsec, nsec = tv->tv_nsec;

	if ((unsigned long)tv->tv_nsec >= NSEC_PER_SEC)
		return -EINVAL;

	write_seqlock_irq(&xtime_lock);
	/*
	 * This is revolting. We need to set "xtime" correctly. However, the
	 * value in this location is the value at the most recent update of
	 * wall time.  Discover what correction gettimeofday() would have
	 * made, and then undo it!
	 */
92
	nsec -= 1000 * (get_timer_offset() +
L
Linus Torvalds 已提交
93 94 95 96 97 98 99 100
				(jiffies - wall_jiffies) * (1000000 / HZ));

	wtm_sec  = wall_to_monotonic.tv_sec + (xtime.tv_sec - sec);
	wtm_nsec = wall_to_monotonic.tv_nsec + (xtime.tv_nsec - nsec);

	set_normalized_timespec(&xtime, sec, nsec);
	set_normalized_timespec(&wall_to_monotonic, wtm_sec, wtm_nsec);

J
john stultz 已提交
101
	ntp_clear();
L
Linus Torvalds 已提交
102 103 104 105 106 107 108 109 110 111 112 113
	write_sequnlock_irq(&xtime_lock);
	clock_was_set();

	return 0;
}

EXPORT_SYMBOL(do_settimeofday);

/* last time the RTC clock got updated */
static long last_rtc_update;

/*
114
 * handle_timer_tick() needs to keep up the real-time clock,
L
Linus Torvalds 已提交
115 116
 * as well as call the "do_timer()" routine every clocktick
 */
117
void handle_timer_tick(struct pt_regs *regs)
L
Linus Torvalds 已提交
118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
{
	do_timer(regs);
#ifndef CONFIG_SMP
	update_process_times(user_mode(regs));
#endif
	profile_tick(CPU_PROFILING, regs);

#ifdef CONFIG_HEARTBEAT
	if (sh_mv.mv_heartbeat != NULL)
		sh_mv.mv_heartbeat();
#endif

	/*
	 * If we have an externally synchronized Linux clock, then update
	 * RTC clock accordingly every ~11 minutes. Set_rtc_mmss() has to be
	 * called as close as possible to 500 ms before the new second starts.
	 */
J
john stultz 已提交
135
	if (ntp_synced() &&
L
Linus Torvalds 已提交
136 137 138 139 140 141
	    xtime.tv_sec > last_rtc_update + 660 &&
	    (xtime.tv_nsec / 1000) >= 500000 - ((unsigned) TICK_SIZE) / 2 &&
	    (xtime.tv_nsec / 1000) <= 500000 + ((unsigned) TICK_SIZE) / 2) {
		if (rtc_set_time(xtime.tv_sec) == 0)
			last_rtc_update = xtime.tv_sec;
		else
142 143
			/* do it again in 60s */
			last_rtc_update = xtime.tv_sec - 600;
L
Linus Torvalds 已提交
144 145 146
	}
}

147 148
static struct sysdev_class timer_sysclass = {
	set_kset_name("timer"),
L
Linus Torvalds 已提交
149 150
};

151
static int __init timer_init_sysfs(void)
L
Linus Torvalds 已提交
152
{
153 154 155
	int ret = sysdev_class_register(&timer_sysclass);
	if (ret != 0)
		return ret;
L
Linus Torvalds 已提交
156

157 158 159
	sys_timer->dev.cls = &timer_sysclass;
	return sysdev_register(&sys_timer->dev);
}
L
Linus Torvalds 已提交
160

161
device_initcall(timer_init_sysfs);
L
Linus Torvalds 已提交
162

163
void (*board_time_init)(void);
L
Linus Torvalds 已提交
164 165 166 167 168 169

void __init time_init(void)
{
	if (board_time_init)
		board_time_init();

170
	clk_init();
L
Linus Torvalds 已提交
171 172 173 174 175 176 177 178 179 180 181 182

	if (rtc_get_time) {
		rtc_get_time(&xtime);
	} else {
		xtime.tv_sec = mktime(2000, 1, 1, 0, 0, 0);
		xtime.tv_nsec = 0;
	}

        set_normalized_timespec(&wall_to_monotonic,
                                -xtime.tv_sec, -xtime.tv_nsec);

	/*
183 184
	 * Find the timer to use as the system timer, it will be
	 * initialized for us.
L
Linus Torvalds 已提交
185
	 */
186 187
	sys_timer = get_sys_timer();
	printk(KERN_INFO "Using %s for system timer\n", sys_timer->name);
L
Linus Torvalds 已提交
188 189 190 191 192 193 194 195 196

#if defined(CONFIG_SH_KGDB)
	/*
	 * Set up kgdb as requested. We do it here because the serial
	 * init uses the timer vars we just set up for figuring baud.
	 */
	kgdb_init();
#endif
}