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 | a2f018b | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 15 | int set_interval(void) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 16 | { |
Jeff Dike | 532d0fa | 2007-10-16 01:27:21 -0700 | [diff] [blame] | 17 | int usec = 1000000/UM_HZ; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 18 | struct itimerval interval = ((struct itimerval) { { 0, usec }, |
| 19 | { 0, usec } }); |
| 20 | |
Jeff Dike | a2f018b | 2007-10-16 01:27:22 -0700 | [diff] [blame] | 21 | if (setitimer(ITIMER_VIRTUAL, &interval, NULL) == -1) |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 22 | return -errno; |
| 23 | |
| 24 | return 0; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 25 | } |
| 26 | |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 27 | int timer_one_shot(int ticks) |
| 28 | { |
| 29 | unsigned long usec = ticks * 1000000 / UM_HZ; |
| 30 | unsigned long sec = usec / 1000000; |
| 31 | struct itimerval interval; |
| 32 | |
| 33 | usec %= 1000000; |
| 34 | interval = ((struct itimerval) { { 0, 0 }, { sec, usec } }); |
| 35 | |
| 36 | if (setitimer(ITIMER_VIRTUAL, &interval, NULL) == -1) |
| 37 | return -errno; |
| 38 | |
| 39 | return 0; |
| 40 | } |
| 41 | |
Jeff Dike | 5f73461 | 2007-10-16 01:27:27 -0700 | [diff] [blame] | 42 | /** |
| 43 | * timeval_to_ns - Convert timeval to nanoseconds |
| 44 | * @ts: pointer to the timeval variable to be converted |
| 45 | * |
| 46 | * Returns the scalar nanosecond representation of the timeval |
| 47 | * parameter. |
| 48 | * |
| 49 | * Ripped from linux/time.h because it's a kernel header, and thus |
| 50 | * unusable from here. |
| 51 | */ |
| 52 | static inline long long timeval_to_ns(const struct timeval *tv) |
| 53 | { |
| 54 | return ((long long) tv->tv_sec * UM_NSEC_PER_SEC) + |
| 55 | tv->tv_usec * UM_NSEC_PER_USEC; |
| 56 | } |
| 57 | |
| 58 | long long disable_timer(void) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 59 | { |
Jeff Dike | b160fb6 | 2007-10-16 01:27:26 -0700 | [diff] [blame] | 60 | struct itimerval time = ((struct itimerval) { { 0, 0 }, { 0, 0 } }); |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 61 | |
Jeff Dike | b160fb6 | 2007-10-16 01:27:26 -0700 | [diff] [blame] | 62 | if(setitimer(ITIMER_VIRTUAL, &time, &time) < 0) |
Jeff Dike | 4c9e138 | 2007-10-16 01:26:54 -0700 | [diff] [blame] | 63 | printk(UM_KERN_ERR "disable_timer - setitimer failed, " |
| 64 | "errno = %d\n", errno); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 65 | |
Jeff Dike | 5f73461 | 2007-10-16 01:27:27 -0700 | [diff] [blame] | 66 | return timeval_to_ns(&time.it_value); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 67 | } |
| 68 | |
Jeff Dike | 5f73461 | 2007-10-16 01:27:27 -0700 | [diff] [blame] | 69 | long long os_nsecs(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | { |
| 71 | struct timeval tv; |
| 72 | |
| 73 | gettimeofday(&tv, NULL); |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 74 | return timeval_to_ns(&tv); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | } |
| 76 | |
Jeff Dike | b160fb6 | 2007-10-16 01:27:26 -0700 | [diff] [blame] | 77 | extern void alarm_handler(int sig, struct sigcontext *sc); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 78 | |
Jeff Dike | b160fb6 | 2007-10-16 01:27:26 -0700 | [diff] [blame] | 79 | void idle_sleep(unsigned long long nsecs) |
| 80 | { |
| 81 | struct timespec ts = { .tv_sec = nsecs / BILLION, |
| 82 | .tv_nsec = nsecs % BILLION }; |
| 83 | |
| 84 | if (nanosleep(&ts, &ts) == 0) |
| 85 | alarm_handler(SIGVTALRM, NULL); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 86 | } |