time.c 3.81 KB
Newer Older
1
/*
Linus Torvalds's avatar
Linus Torvalds committed
2 3 4 5 6 7 8 9 10 11 12 13 14 15
 * Copyright (C) 2000 Jeff Dike (jdike@karaya.com)
 * Licensed under the GPL
 */

#include "linux/kernel.h"
#include "linux/module.h"
#include "linux/unistd.h"
#include "linux/stddef.h"
#include "linux/spinlock.h"
#include "linux/time.h"
#include "linux/sched.h"
#include "linux/interrupt.h"
#include "linux/init.h"
#include "linux/delay.h"
16
#include "linux/hrtimer.h"
Linus Torvalds's avatar
Linus Torvalds committed
17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37
#include "asm/irq.h"
#include "asm/param.h"
#include "asm/current.h"
#include "kern_util.h"
#include "user_util.h"
#include "mode.h"
#include "os.h"

int hz(void)
{
	return(HZ);
}

/*
 * Scheduler clock - returns current time in nanosec units.
 */
unsigned long long sched_clock(void)
{
	return (unsigned long long)jiffies_64 * (1000000000 / HZ);
}

38
static unsigned long long prev_nsecs;
Linus Torvalds's avatar
Linus Torvalds committed
39 40 41 42 43 44 45 46 47
#ifdef CONFIG_UML_REAL_TIME_CLOCK
static long long delta;   		/* Deviation per interval */
#endif

void timer_irq(union uml_pt_regs *regs)
{
	unsigned long long ticks = 0;

#ifdef CONFIG_UML_REAL_TIME_CLOCK
48
	if(prev_nsecs){
Linus Torvalds's avatar
Linus Torvalds committed
49
		/* We've had 1 tick */
50
		unsigned long long nsecs = os_nsecs();
Linus Torvalds's avatar
Linus Torvalds committed
51

52 53
		delta += nsecs - prev_nsecs;
		prev_nsecs = nsecs;
Linus Torvalds's avatar
Linus Torvalds committed
54 55 56 57 58

		/* Protect against the host clock being set backwards */
		if(delta < 0)
			delta = 0;

59 60
		ticks += (delta * HZ) / BILLION;
		delta -= (ticks * BILLION) / HZ;
61 62
	}
	else prev_nsecs = os_nsecs();
Linus Torvalds's avatar
Linus Torvalds committed
63
#else
64
	ticks = 1;
Linus Torvalds's avatar
Linus Torvalds committed
65 66 67 68 69 70 71
#endif
	while(ticks > 0){
		do_IRQ(TIMER_IRQ, regs);
		ticks--;
	}
}

72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
static DEFINE_SPINLOCK(timer_spinlock);

static unsigned long long local_offset = 0;

static inline unsigned long long get_time(void)
{
	unsigned long long nsecs;
	unsigned long flags;

	spin_lock_irqsave(&timer_spinlock, flags);
	nsecs = os_nsecs();
	nsecs += local_offset;
	spin_unlock_irqrestore(&timer_spinlock, flags);

	return nsecs;
}

Linus Torvalds's avatar
Linus Torvalds committed
89 90
irqreturn_t um_timer(int irq, void *dev, struct pt_regs *regs)
{
91
	unsigned long long nsecs;
Linus Torvalds's avatar
Linus Torvalds committed
92 93
	unsigned long flags;

94 95
	write_seqlock_irqsave(&xtime_lock, flags);

Linus Torvalds's avatar
Linus Torvalds committed
96
	do_timer(regs);
97 98 99 100

	nsecs = get_time() + local_offset;
	xtime.tv_sec = nsecs / NSEC_PER_SEC;
	xtime.tv_nsec = nsecs - xtime.tv_sec * NSEC_PER_SEC;
101

Linus Torvalds's avatar
Linus Torvalds committed
102
	write_sequnlock_irqrestore(&xtime_lock, flags);
103

104
	return IRQ_HANDLED;
Linus Torvalds's avatar
Linus Torvalds committed
105 106
}

107 108 109 110 111 112
static void register_timer(void)
{
	int err;

	err = request_irq(TIMER_IRQ, um_timer, IRQF_DISABLED, "timer", NULL);
	if(err != 0)
Jeff Dike's avatar
Jeff Dike committed
113
		printk(KERN_ERR "register_timer : request_irq failed - "
114 115
		       "errno = %d\n", -err);

Jeff Dike's avatar
Jeff Dike committed
116 117 118 119
	err = set_interval(1);
	if(err != 0)
		printk(KERN_ERR "register_timer : set_interval failed - "
		       "errno = %d\n", -err);
120 121 122 123 124 125 126 127 128 129 130 131 132 133
}

extern void (*late_time_init)(void);

void time_init(void)
{
	long long nsecs;

	nsecs = os_nsecs();
	set_normalized_timespec(&wall_to_monotonic, -nsecs / BILLION,
				-nsecs % BILLION);
	late_time_init = register_timer;
}

134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159
void do_gettimeofday(struct timeval *tv)
{
	unsigned long long nsecs = get_time();

	tv->tv_sec = nsecs / NSEC_PER_SEC;
	/* Careful about calculations here - this was originally done as
	 * (nsecs - tv->tv_sec * NSEC_PER_SEC) / NSEC_PER_USEC
	 * which gave bogus (> 1000000) values.  Dunno why, suspect gcc
	 * (4.0.0) miscompiled it, or there's a subtle 64/32-bit conversion
	 * problem that I missed.
	 */
	nsecs -= tv->tv_sec * NSEC_PER_SEC;
	tv->tv_usec = (unsigned long) nsecs / NSEC_PER_USEC;
}

static inline void set_time(unsigned long long nsecs)
{
	unsigned long long now;
	unsigned long flags;

	spin_lock_irqsave(&timer_spinlock, flags);
	now = os_nsecs();
	local_offset = nsecs - now;
	spin_unlock_irqrestore(&timer_spinlock, flags);

	clock_was_set();
Linus Torvalds's avatar
Linus Torvalds committed
160 161
}

162 163 164 165
int do_settimeofday(struct timespec *tv)
{
	set_time((unsigned long long) tv->tv_sec * NSEC_PER_SEC + tv->tv_nsec);

Linus Torvalds's avatar
Linus Torvalds committed
166 167 168 169 170 171
	return 0;
}

void timer_handler(int sig, union uml_pt_regs *regs)
{
	local_irq_disable();
172
	irq_enter();
173 174 175
	update_process_times(CHOOSE_MODE(
	                     (UPT_SC(regs) && user_context(UPT_SP(regs))),
			     (regs)->skas.is_user));
176
	irq_exit();
Linus Torvalds's avatar
Linus Torvalds committed
177 178 179 180
	local_irq_enable();
	if(current_thread->cpu == 0)
		timer_irq(regs);
}