Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 1 | /* |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 2 | * Copyright (C) 2000 - 2007 Jeff Dike (jdike{addtoit,linux.intel}.com) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 3 | * Licensed under the GPL |
| 4 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5 | |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 6 | #include <stddef.h> |
| 7 | #include <errno.h> |
| 8 | #include <signal.h> |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 9 | #include <time.h> |
| 10 | #include <sys/time.h> |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 11 | #include "kern_constants.h" |
| 12 | #include "os.h" |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 13 | #include "user.h" |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 14 | |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 15 | static int is_real_timer = 0; |
| 16 | |
Jeff Dike | a2f018b | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 17 | int set_interval(void) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 18 | { |
Jeff Dike | 532d0fa | 2007-10-16 01:27:21 -0700 | [diff] [blame] | 19 | int usec = 1000000/UM_HZ; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 20 | struct itimerval interval = ((struct itimerval) { { 0, usec }, |
| 21 | { 0, usec } }); |
| 22 | |
Jeff Dike | a2f018b | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 23 | if (setitimer(ITIMER_VIRTUAL, &interval, NULL) == -1) |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 24 | return -errno; |
| 25 | |
| 26 | return 0; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 27 | } |
| 28 | |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame^] | 29 | int timer_one_shot(int ticks) |
| 30 | { |
| 31 | unsigned long usec = ticks * 1000000 / UM_HZ; |
| 32 | unsigned long sec = usec / 1000000; |
| 33 | struct itimerval interval; |
| 34 | |
| 35 | usec %= 1000000; |
| 36 | interval = ((struct itimerval) { { 0, 0 }, { sec, usec } }); |
| 37 | |
| 38 | if (setitimer(ITIMER_VIRTUAL, &interval, NULL) == -1) |
| 39 | return -errno; |
| 40 | |
| 41 | return 0; |
| 42 | } |
| 43 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 44 | void disable_timer(void) |
| 45 | { |
| 46 | struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 47 | |
| 48 | if ((setitimer(ITIMER_VIRTUAL, &disable, NULL) < 0) || |
| 49 | (setitimer(ITIMER_REAL, &disable, NULL) < 0)) |
| 50 | printk(UM_KERN_ERR "disable_timer - setitimer failed, " |
| 51 | "errno = %d\n", errno); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 52 | } |
| 53 | |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 54 | int switch_timers(int to_real) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 55 | { |
| 56 | struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 57 | struct itimerval enable; |
| 58 | int old, new, old_type = is_real_timer; |
| 59 | |
| 60 | if(to_real == old_type) |
| 61 | return to_real; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 62 | |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 63 | if (to_real) { |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 64 | old = ITIMER_VIRTUAL; |
| 65 | new = ITIMER_REAL; |
| 66 | } |
| 67 | else { |
| 68 | old = ITIMER_REAL; |
| 69 | new = ITIMER_VIRTUAL; |
| 70 | } |
| 71 | |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 72 | if (setitimer(old, &disable, &enable) < 0) |
| 73 | printk(UM_KERN_ERR "switch_timers - setitimer disable failed, " |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 74 | "errno = %d\n", errno); |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 75 | |
| 76 | if((enable.it_value.tv_sec == 0) && (enable.it_value.tv_usec == 0)) |
| 77 | enable.it_value = enable.it_interval; |
| 78 | |
| 79 | if (setitimer(new, &enable, NULL)) |
| 80 | printk(UM_KERN_ERR "switch_timers - setitimer enable failed, " |
| 81 | "errno = %d\n", errno); |
| 82 | |
| 83 | is_real_timer = to_real; |
| 84 | return old_type; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 85 | } |
| 86 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 87 | unsigned long long os_nsecs(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | { |
| 89 | struct timeval tv; |
| 90 | |
| 91 | gettimeofday(&tv, NULL); |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame^] | 92 | return timeval_to_ns(&tv); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | } |
| 94 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 95 | void idle_sleep(int secs) |
| 96 | { |
| 97 | struct timespec ts; |
| 98 | |
| 99 | ts.tv_sec = secs; |
| 100 | ts.tv_nsec = 0; |
| 101 | nanosleep(&ts, NULL); |
| 102 | } |