/* * Copyright (C) 2000, 2001, 2002 Jeff Dike (jdike@karaya.com) * Licensed under the GPL */ #include #include #include #include #include #include #include #include "user_util.h" #include "kern_util.h" #include "user.h" #include "process.h" #include "time_user.h" #include "kern_constants.h" #include "os.h" /* XXX This really needs to be declared and initialized in a kernel file since * it's in */ extern struct timespec wall_to_monotonic; extern struct timeval xtime; struct timeval local_offset = { 0, 0 }; void timer(void) { gettimeofday(&xtime, NULL); timeradd(&xtime, &local_offset, &xtime); } static void set_interval(int timer_type) { int usec = 1000000/hz(); struct itimerval interval = ((struct itimerval) { { 0, usec }, { 0, usec } }); if(setitimer(timer_type, &interval, NULL) == -1) panic("setitimer failed - errno = %d\n", errno); } void enable_timer(void) { set_interval(ITIMER_VIRTUAL); } void prepare_timer(void * ptr) { int usec = 1000000/hz(); *(struct itimerval *)ptr = ((struct itimerval) { { 0, usec }, { 0, usec }}); } void disable_timer(void) { struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); if((setitimer(ITIMER_VIRTUAL, &disable, NULL) < 0) || (setitimer(ITIMER_REAL, &disable, NULL) < 0)) printk("disnable_timer - setitimer failed, errno = %d\n", errno); /* If there are signals already queued, after unblocking ignore them */ set_handler(SIGALRM, SIG_IGN, 0, -1); set_handler(SIGVTALRM, SIG_IGN, 0, -1); } void switch_timers(int to_real) { struct itimerval disable = ((struct itimerval) { { 0, 0 }, { 0, 0 }}); struct itimerval enable = ((struct itimerval) { { 0, 1000000/hz() }, { 0, 1000000/hz() }}); int old, new; if(to_real){ old = ITIMER_VIRTUAL; new = ITIMER_REAL; } else { old = ITIMER_REAL; new = ITIMER_VIRTUAL; } if((setitimer(old, &disable, NULL) < 0) || (setitimer(new, &enable, NULL))) printk("switch_timers - setitimer failed, errno = %d\n", errno); } void uml_idle_timer(void) { if(signal(SIGVTALRM, SIG_IGN) == SIG_ERR) panic("Couldn't unset SIGVTALRM handler"); set_handler(SIGALRM, (__sighandler_t) alarm_handler, SA_RESTART, SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1); set_interval(ITIMER_REAL); } extern void ktime_get_ts(struct timespec *ts); #define do_posix_clock_monotonic_gettime(ts) ktime_get_ts(ts) void time_init(void) { struct timespec now; if(signal(SIGVTALRM, boot_timer_handler) == SIG_ERR) panic("Couldn't set SIGVTALRM handler"); set_interval(ITIMER_VIRTUAL); do_posix_clock_monotonic_gettime(&now); wall_to_monotonic.tv_sec = -now.tv_sec; wall_to_monotonic.tv_nsec = -now.tv_nsec; } /* Defined in linux/ktimer.h, which can't be included here */ #define clock_was_set() do { } while (0) void do_gettimeofday(struct timeval *tv) { unsigned long flags; flags = time_lock(); gettimeofday(tv, NULL); timeradd(tv, &local_offset, tv); time_unlock(flags); clock_was_set(); } int do_settimeofday(struct timespec *tv) { struct timeval now; unsigned long flags; struct timeval tv_in; if ((unsigned long) tv->tv_nsec >= UM_NSEC_PER_SEC) return -EINVAL; tv_in.tv_sec = tv->tv_sec; tv_in.tv_usec = tv->tv_nsec / 1000; flags = time_lock(); gettimeofday(&now, NULL); timersub(&tv_in, &now, &local_offset); time_unlock(flags); return(0); } void idle_sleep(int secs) { struct timespec ts; ts.tv_sec = secs; ts.tv_nsec = 0; nanosleep(&ts, NULL); } /* XXX This partly duplicates init_irq_signals */ void user_time_init(void) { set_handler(SIGVTALRM, (__sighandler_t) alarm_handler, SA_ONSTACK | SA_RESTART, SIGUSR1, SIGIO, SIGWINCH, SIGALRM, SIGUSR2, -1); set_handler(SIGALRM, (__sighandler_t) alarm_handler, SA_ONSTACK | SA_RESTART, SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, SIGUSR2, -1); set_interval(ITIMER_VIRTUAL); }