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 | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 17 | int set_interval(int is_virtual) |
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; |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 20 | int timer_type = is_virtual ? ITIMER_VIRTUAL : ITIMER_REAL; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 21 | struct itimerval interval = ((struct itimerval) { { 0, usec }, |
| 22 | { 0, usec } }); |
| 23 | |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 24 | if (setitimer(timer_type, &interval, NULL) == -1) |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 25 | return -errno; |
| 26 | |
| 27 | return 0; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 28 | } |
| 29 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 30 | void disable_timer(void) |
| 31 | { |
| 32 | struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 33 | |
| 34 | if ((setitimer(ITIMER_VIRTUAL, &disable, NULL) < 0) || |
| 35 | (setitimer(ITIMER_REAL, &disable, NULL) < 0)) |
| 36 | printk(UM_KERN_ERR "disable_timer - setitimer failed, " |
| 37 | "errno = %d\n", errno); |
| 38 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 39 | /* If there are signals already queued, after unblocking ignore them */ |
Jeff Dike | 4b84c69 | 2006-09-25 23:33:04 -0700 | [diff] [blame] | 40 | signal(SIGALRM, SIG_IGN); |
| 41 | signal(SIGVTALRM, SIG_IGN); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 42 | } |
| 43 | |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame^] | 44 | int switch_timers(int to_real) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 45 | { |
| 46 | struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame^] | 47 | struct itimerval enable; |
| 48 | int old, new, old_type = is_real_timer; |
| 49 | |
| 50 | if(to_real == old_type) |
| 51 | return to_real; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 52 | |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 53 | if (to_real) { |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 54 | old = ITIMER_VIRTUAL; |
| 55 | new = ITIMER_REAL; |
| 56 | } |
| 57 | else { |
| 58 | old = ITIMER_REAL; |
| 59 | new = ITIMER_VIRTUAL; |
| 60 | } |
| 61 | |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame^] | 62 | if (setitimer(old, &disable, &enable) < 0) |
| 63 | printk(UM_KERN_ERR "switch_timers - setitimer disable failed, " |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 64 | "errno = %d\n", errno); |
Jeff Dike | 181bde8 | 2007-10-16 01:27:22 -0700 | [diff] [blame^] | 65 | |
| 66 | if((enable.it_value.tv_sec == 0) && (enable.it_value.tv_usec == 0)) |
| 67 | enable.it_value = enable.it_interval; |
| 68 | |
| 69 | if (setitimer(new, &enable, NULL)) |
| 70 | printk(UM_KERN_ERR "switch_timers - setitimer enable failed, " |
| 71 | "errno = %d\n", errno); |
| 72 | |
| 73 | is_real_timer = to_real; |
| 74 | return old_type; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 75 | } |
| 76 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 77 | unsigned long long os_nsecs(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | { |
| 79 | struct timeval tv; |
| 80 | |
| 81 | gettimeofday(&tv, NULL); |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 82 | return (unsigned long long) tv.tv_sec * BILLION + tv.tv_usec * 1000; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | } |
| 84 | |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 85 | void idle_sleep(int secs) |
| 86 | { |
| 87 | struct timespec ts; |
| 88 | |
| 89 | ts.tv_sec = secs; |
| 90 | ts.tv_nsec = 0; |
| 91 | nanosleep(&ts, NULL); |
| 92 | } |