Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2001 Andrea Arcangeli <andrea@suse.de> SuSE |
| 3 | * Copyright 2003 Andi Kleen, SuSE Labs. |
| 4 | * |
| 5 | * Modified for x86 32 bit architecture by |
| 6 | * Stefani Seibold <stefani@seibold.net> |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 7 | * sponsored by Rohde & Schwarz GmbH & Co. KG Munich/Germany |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 8 | * |
| 9 | * Thanks to hpa@transmeta.com for some useful hint. |
| 10 | * Special thanks to Ingo Molnar for his early experience with |
| 11 | * a different vsyscall implementation for Linux/IA32 and for the name. |
| 12 | * |
| 13 | */ |
| 14 | |
| 15 | #include <linux/timekeeper_internal.h> |
| 16 | #include <asm/vgtod.h> |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 17 | #include <asm/vvar.h> |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 18 | |
| 19 | DEFINE_VVAR(struct vsyscall_gtod_data, vsyscall_gtod_data); |
| 20 | |
| 21 | void update_vsyscall_tz(void) |
| 22 | { |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 23 | vsyscall_gtod_data.tz_minuteswest = sys_tz.tz_minuteswest; |
| 24 | vsyscall_gtod_data.tz_dsttime = sys_tz.tz_dsttime; |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 25 | } |
| 26 | |
| 27 | void update_vsyscall(struct timekeeper *tk) |
| 28 | { |
| 29 | struct vsyscall_gtod_data *vdata = &vsyscall_gtod_data; |
| 30 | |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 31 | gtod_write_begin(vdata); |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 32 | |
| 33 | /* copy vsyscall data */ |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 34 | vdata->vclock_mode = tk->tkr.clock->archdata.vclock_mode; |
| 35 | vdata->cycle_last = tk->tkr.cycle_last; |
| 36 | vdata->mask = tk->tkr.mask; |
| 37 | vdata->mult = tk->tkr.mult; |
| 38 | vdata->shift = tk->tkr.shift; |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 39 | |
| 40 | vdata->wall_time_sec = tk->xtime_sec; |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 41 | vdata->wall_time_snsec = tk->tkr.xtime_nsec; |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 42 | |
| 43 | vdata->monotonic_time_sec = tk->xtime_sec |
| 44 | + tk->wall_to_monotonic.tv_sec; |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 45 | vdata->monotonic_time_snsec = tk->tkr.xtime_nsec |
Boris Ostrovsky | 28b92e0 | 2014-05-09 11:11:27 -0400 | [diff] [blame] | 46 | + ((u64)tk->wall_to_monotonic.tv_nsec |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 47 | << tk->tkr.shift); |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 48 | while (vdata->monotonic_time_snsec >= |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 49 | (((u64)NSEC_PER_SEC) << tk->tkr.shift)) { |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 50 | vdata->monotonic_time_snsec -= |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 51 | ((u64)NSEC_PER_SEC) << tk->tkr.shift; |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 52 | vdata->monotonic_time_sec++; |
| 53 | } |
| 54 | |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 55 | vdata->wall_time_coarse_sec = tk->xtime_sec; |
Thomas Gleixner | d28ede8 | 2014-07-16 21:05:16 +0000 | [diff] [blame] | 56 | vdata->wall_time_coarse_nsec = (long)(tk->tkr.xtime_nsec >> |
| 57 | tk->tkr.shift); |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 58 | |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 59 | vdata->monotonic_time_coarse_sec = |
| 60 | vdata->wall_time_coarse_sec + tk->wall_to_monotonic.tv_sec; |
| 61 | vdata->monotonic_time_coarse_nsec = |
| 62 | vdata->wall_time_coarse_nsec + tk->wall_to_monotonic.tv_nsec; |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 63 | |
Stefani Seibold | 7c03156 | 2014-03-17 23:22:10 +0100 | [diff] [blame] | 64 | while (vdata->monotonic_time_coarse_nsec >= NSEC_PER_SEC) { |
| 65 | vdata->monotonic_time_coarse_nsec -= NSEC_PER_SEC; |
| 66 | vdata->monotonic_time_coarse_sec++; |
| 67 | } |
| 68 | |
| 69 | gtod_write_end(vdata); |
Stefani Seibold | d2312e3 | 2014-03-17 23:22:01 +0100 | [diff] [blame] | 70 | } |