Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-2.6
[pandora-kernel.git] / arch / x86 / kernel / kvmclock.c
1 /*  KVM paravirtual clock driver. A clocksource implementation
2     Copyright (C) 2008 Glauber de Oliveira Costa, Red Hat Inc.
3
4     This program is free software; you can redistribute it and/or modify
5     it under the terms of the GNU General Public License as published by
6     the Free Software Foundation; either version 2 of the License, or
7     (at your option) any later version.
8
9     This program is distributed in the hope that it will be useful,
10     but WITHOUT ANY WARRANTY; without even the implied warranty of
11     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12     GNU General Public License for more details.
13
14     You should have received a copy of the GNU General Public License
15     along with this program; if not, write to the Free Software
16     Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
17 */
18
19 #include <linux/clocksource.h>
20 #include <linux/kvm_para.h>
21 #include <asm/arch_hooks.h>
22 #include <asm/msr.h>
23 #include <asm/apic.h>
24 #include <linux/percpu.h>
25 #include <asm/reboot.h>
26
27 #define KVM_SCALE 22
28
29 static int kvmclock = 1;
30
31 static int parse_no_kvmclock(char *arg)
32 {
33         kvmclock = 0;
34         return 0;
35 }
36 early_param("no-kvmclock", parse_no_kvmclock);
37
38 /* The hypervisor will put information about time periodically here */
39 static DEFINE_PER_CPU_SHARED_ALIGNED(struct kvm_vcpu_time_info, hv_clock);
40 #define get_clock(cpu, field) per_cpu(hv_clock, cpu).field
41
42 static inline u64 kvm_get_delta(u64 last_tsc)
43 {
44         int cpu = smp_processor_id();
45         u64 delta = native_read_tsc() - last_tsc;
46         return (delta * get_clock(cpu, tsc_to_system_mul)) >> KVM_SCALE;
47 }
48
49 static struct kvm_wall_clock wall_clock;
50 static cycle_t kvm_clock_read(void);
51 /*
52  * The wallclock is the time of day when we booted. Since then, some time may
53  * have elapsed since the hypervisor wrote the data. So we try to account for
54  * that with system time
55  */
56 unsigned long kvm_get_wallclock(void)
57 {
58         u32 wc_sec, wc_nsec;
59         u64 delta;
60         struct timespec ts;
61         int version, nsec;
62         int low, high;
63
64         low = (int)__pa(&wall_clock);
65         high = ((u64)__pa(&wall_clock) >> 32);
66
67         delta = kvm_clock_read();
68
69         native_write_msr(MSR_KVM_WALL_CLOCK, low, high);
70         do {
71                 version = wall_clock.wc_version;
72                 rmb();
73                 wc_sec = wall_clock.wc_sec;
74                 wc_nsec = wall_clock.wc_nsec;
75                 rmb();
76         } while ((wall_clock.wc_version != version) || (version & 1));
77
78         delta = kvm_clock_read() - delta;
79         delta += wc_nsec;
80         nsec = do_div(delta, NSEC_PER_SEC);
81         set_normalized_timespec(&ts, wc_sec + delta, nsec);
82         /*
83          * Of all mechanisms of time adjustment I've tested, this one
84          * was the champion!
85          */
86         return ts.tv_sec + 1;
87 }
88
89 int kvm_set_wallclock(unsigned long now)
90 {
91         return 0;
92 }
93
94 /*
95  * This is our read_clock function. The host puts an tsc timestamp each time
96  * it updates a new time. Without the tsc adjustment, we can have a situation
97  * in which a vcpu starts to run earlier (smaller system_time), but probes
98  * time later (compared to another vcpu), leading to backwards time
99  */
100 static cycle_t kvm_clock_read(void)
101 {
102         u64 last_tsc, now;
103         int cpu;
104
105         preempt_disable();
106         cpu = smp_processor_id();
107
108         last_tsc = get_clock(cpu, tsc_timestamp);
109         now = get_clock(cpu, system_time);
110
111         now += kvm_get_delta(last_tsc);
112         preempt_enable();
113
114         return now;
115 }
116 static struct clocksource kvm_clock = {
117         .name = "kvm-clock",
118         .read = kvm_clock_read,
119         .rating = 400,
120         .mask = CLOCKSOURCE_MASK(64),
121         .mult = 1 << KVM_SCALE,
122         .shift = KVM_SCALE,
123         .flags = CLOCK_SOURCE_IS_CONTINUOUS,
124 };
125
126 static int kvm_register_clock(void)
127 {
128         int cpu = smp_processor_id();
129         int low, high;
130         low = (int)__pa(&per_cpu(hv_clock, cpu)) | 1;
131         high = ((u64)__pa(&per_cpu(hv_clock, cpu)) >> 32);
132
133         return native_write_msr_safe(MSR_KVM_SYSTEM_TIME, low, high);
134 }
135
136 static void kvm_setup_secondary_clock(void)
137 {
138         /*
139          * Now that the first cpu already had this clocksource initialized,
140          * we shouldn't fail.
141          */
142         WARN_ON(kvm_register_clock());
143         /* ok, done with our trickery, call native */
144         setup_secondary_APIC_clock();
145 }
146
147 /*
148  * After the clock is registered, the host will keep writing to the
149  * registered memory location. If the guest happens to shutdown, this memory
150  * won't be valid. In cases like kexec, in which you install a new kernel, this
151  * means a random memory location will be kept being written. So before any
152  * kind of shutdown from our side, we unregister the clock by writting anything
153  * that does not have the 'enable' bit set in the msr
154  */
155 #ifdef CONFIG_KEXEC
156 static void kvm_crash_shutdown(struct pt_regs *regs)
157 {
158         native_write_msr_safe(MSR_KVM_SYSTEM_TIME, 0, 0);
159         native_machine_crash_shutdown(regs);
160 }
161 #endif
162
163 static void kvm_shutdown(void)
164 {
165         native_write_msr_safe(MSR_KVM_SYSTEM_TIME, 0, 0);
166         native_machine_shutdown();
167 }
168
169 void __init kvmclock_init(void)
170 {
171         if (!kvm_para_available())
172                 return;
173
174         if (kvmclock && kvm_para_has_feature(KVM_FEATURE_CLOCKSOURCE)) {
175                 if (kvm_register_clock())
176                         return;
177                 pv_time_ops.get_wallclock = kvm_get_wallclock;
178                 pv_time_ops.set_wallclock = kvm_set_wallclock;
179                 pv_time_ops.sched_clock = kvm_clock_read;
180                 pv_apic_ops.setup_secondary_clock = kvm_setup_secondary_clock;
181                 machine_ops.shutdown  = kvm_shutdown;
182 #ifdef CONFIG_KEXEC
183                 machine_ops.crash_shutdown  = kvm_crash_shutdown;
184 #endif
185                 clocksource_register(&kvm_clock);
186         }
187 }