| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
| Uwe Zeisberger | f30c226 | 2006-10-03 23:01:26 +0200 | [diff] [blame] | 2 | * linux/kernel/posix-timers.c | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * | 
|  | 4 | * | 
|  | 5 | * 2002-10-15  Posix Clocks & timers | 
|  | 6 | *                           by George Anzinger george@mvista.com | 
|  | 7 | * | 
|  | 8 | *			     Copyright (C) 2002 2003 by MontaVista Software. | 
|  | 9 | * | 
|  | 10 | * 2004-06-01  Fix CLOCK_REALTIME clock/timer TIMER_ABSTIME bug. | 
|  | 11 | *			     Copyright (C) 2004 Boris Hu | 
|  | 12 | * | 
|  | 13 | * This program is free software; you can redistribute it and/or modify | 
|  | 14 | * it under the terms of the GNU General Public License as published by | 
|  | 15 | * the Free Software Foundation; either version 2 of the License, or (at | 
|  | 16 | * your option) any later version. | 
|  | 17 | * | 
|  | 18 | * This program is distributed in the hope that it will be useful, but | 
|  | 19 | * WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | 
|  | 21 | * General Public License for more details. | 
|  | 22 |  | 
|  | 23 | * You should have received a copy of the GNU General Public License | 
|  | 24 | * along with this program; if not, write to the Free Software | 
|  | 25 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | 26 | * | 
|  | 27 | * MontaVista Software | 1237 East Arques Avenue | Sunnyvale | CA 94085 | USA | 
|  | 28 | */ | 
|  | 29 |  | 
|  | 30 | /* These are all the functions necessary to implement | 
|  | 31 | * POSIX clocks & timers | 
|  | 32 | */ | 
|  | 33 | #include <linux/mm.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #include <linux/interrupt.h> | 
|  | 35 | #include <linux/slab.h> | 
|  | 36 | #include <linux/time.h> | 
| Arjan van de Ven | 97d1f15 | 2006-03-23 03:00:24 -0800 | [diff] [blame] | 37 | #include <linux/mutex.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 |  | 
|  | 39 | #include <asm/uaccess.h> | 
|  | 40 | #include <asm/semaphore.h> | 
|  | 41 | #include <linux/list.h> | 
|  | 42 | #include <linux/init.h> | 
|  | 43 | #include <linux/compiler.h> | 
|  | 44 | #include <linux/idr.h> | 
|  | 45 | #include <linux/posix-timers.h> | 
|  | 46 | #include <linux/syscalls.h> | 
|  | 47 | #include <linux/wait.h> | 
|  | 48 | #include <linux/workqueue.h> | 
|  | 49 | #include <linux/module.h> | 
|  | 50 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | /* | 
|  | 52 | * Management arrays for POSIX timers.	 Timers are kept in slab memory | 
|  | 53 | * Timer ids are allocated by an external routine that keeps track of the | 
|  | 54 | * id and the timer.  The external interface is: | 
|  | 55 | * | 
|  | 56 | * void *idr_find(struct idr *idp, int id);           to find timer_id <id> | 
|  | 57 | * int idr_get_new(struct idr *idp, void *ptr);       to get a new id and | 
|  | 58 | *                                                    related it to <ptr> | 
|  | 59 | * void idr_remove(struct idr *idp, int id);          to release <id> | 
|  | 60 | * void idr_init(struct idr *idp);                    to initialize <idp> | 
|  | 61 | *                                                    which we supply. | 
|  | 62 | * The idr_get_new *may* call slab for more memory so it must not be | 
|  | 63 | * called under a spin lock.  Likewise idr_remore may release memory | 
|  | 64 | * (but it may be ok to do this under a lock...). | 
|  | 65 | * idr_find is just a memory look up and is quite fast.  A -1 return | 
|  | 66 | * indicates that the requested id does not exist. | 
|  | 67 | */ | 
|  | 68 |  | 
|  | 69 | /* | 
|  | 70 | * Lets keep our timers in a slab cache :-) | 
|  | 71 | */ | 
| Christoph Lameter | e18b890 | 2006-12-06 20:33:20 -0800 | [diff] [blame] | 72 | static struct kmem_cache *posix_timers_cache; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | static struct idr posix_timers_id; | 
|  | 74 | static DEFINE_SPINLOCK(idr_lock); | 
|  | 75 |  | 
|  | 76 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | * we assume that the new SIGEV_THREAD_ID shares no bits with the other | 
|  | 78 | * SIGEV values.  Here we put out an error if this assumption fails. | 
|  | 79 | */ | 
|  | 80 | #if SIGEV_THREAD_ID != (SIGEV_THREAD_ID & \ | 
|  | 81 | ~(SIGEV_SIGNAL | SIGEV_NONE | SIGEV_THREAD)) | 
|  | 82 | #error "SIGEV_THREAD_ID must not share bit with other SIGEV values!" | 
|  | 83 | #endif | 
|  | 84 |  | 
|  | 85 |  | 
|  | 86 | /* | 
|  | 87 | * The timer ID is turned into a timer address by idr_find(). | 
|  | 88 | * Verifying a valid ID consists of: | 
|  | 89 | * | 
|  | 90 | * a) checking that idr_find() returns other than -1. | 
|  | 91 | * b) checking that the timer id matches the one in the timer itself. | 
|  | 92 | * c) that the timer owner is in the callers thread group. | 
|  | 93 | */ | 
|  | 94 |  | 
|  | 95 | /* | 
|  | 96 | * CLOCKs: The POSIX standard calls for a couple of clocks and allows us | 
|  | 97 | *	    to implement others.  This structure defines the various | 
|  | 98 | *	    clocks and allows the possibility of adding others.	 We | 
|  | 99 | *	    provide an interface to add clocks to the table and expect | 
|  | 100 | *	    the "arch" code to add at least one clock that is high | 
|  | 101 | *	    resolution.	 Here we define the standard CLOCK_REALTIME as a | 
|  | 102 | *	    1/HZ resolution clock. | 
|  | 103 | * | 
|  | 104 | * RESOLUTION: Clock resolution is used to round up timer and interval | 
|  | 105 | *	    times, NOT to report clock times, which are reported with as | 
|  | 106 | *	    much resolution as the system can muster.  In some cases this | 
|  | 107 | *	    resolution may depend on the underlying clock hardware and | 
|  | 108 | *	    may not be quantifiable until run time, and only then is the | 
|  | 109 | *	    necessary code is written.	The standard says we should say | 
|  | 110 | *	    something about this issue in the documentation... | 
|  | 111 | * | 
|  | 112 | * FUNCTIONS: The CLOCKs structure defines possible functions to handle | 
|  | 113 | *	    various clock functions.  For clocks that use the standard | 
|  | 114 | *	    system timer code these entries should be NULL.  This will | 
|  | 115 | *	    allow dispatch without the overhead of indirect function | 
|  | 116 | *	    calls.  CLOCKS that depend on other sources (e.g. WWV or GPS) | 
|  | 117 | *	    must supply functions here, even if the function just returns | 
|  | 118 | *	    ENOSYS.  The standard POSIX timer management code assumes the | 
|  | 119 | *	    following: 1.) The k_itimer struct (sched.h) is used for the | 
|  | 120 | *	    timer.  2.) The list, it_lock, it_clock, it_id and it_process | 
|  | 121 | *	    fields are not modified by timer code. | 
|  | 122 | * | 
|  | 123 | *          At this time all functions EXCEPT clock_nanosleep can be | 
|  | 124 | *          redirected by the CLOCKS structure.  Clock_nanosleep is in | 
|  | 125 | *          there, but the code ignores it. | 
|  | 126 | * | 
|  | 127 | * Permissions: It is assumed that the clock_settime() function defined | 
|  | 128 | *	    for each clock will take care of permission checks.	 Some | 
|  | 129 | *	    clocks may be set able by any user (i.e. local process | 
|  | 130 | *	    clocks) others not.	 Currently the only set able clock we | 
|  | 131 | *	    have is CLOCK_REALTIME and its high res counter part, both of | 
|  | 132 | *	    which we beg off on and pass to do_sys_settimeofday(). | 
|  | 133 | */ | 
|  | 134 |  | 
|  | 135 | static struct k_clock posix_clocks[MAX_CLOCKS]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 137 | /* | 
|  | 138 | * These ones are defined below. | 
|  | 139 | */ | 
|  | 140 | static int common_nsleep(const clockid_t, int flags, struct timespec *t, | 
|  | 141 | struct timespec __user *rmtp); | 
|  | 142 | static void common_timer_get(struct k_itimer *, struct itimerspec *); | 
|  | 143 | static int common_timer_set(struct k_itimer *, int, | 
|  | 144 | struct itimerspec *, struct itimerspec *); | 
|  | 145 | static int common_timer_del(struct k_itimer *timer); | 
|  | 146 |  | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 147 | static enum hrtimer_restart posix_timer_fn(struct hrtimer *data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 |  | 
|  | 149 | static struct k_itimer *lock_timer(timer_t timer_id, unsigned long *flags); | 
|  | 150 |  | 
|  | 151 | static inline void unlock_timer(struct k_itimer *timr, unsigned long flags) | 
|  | 152 | { | 
|  | 153 | spin_unlock_irqrestore(&timr->it_lock, flags); | 
|  | 154 | } | 
|  | 155 |  | 
|  | 156 | /* | 
|  | 157 | * Call the k_clock hook function if non-null, or the default function. | 
|  | 158 | */ | 
|  | 159 | #define CLOCK_DISPATCH(clock, call, arglist) \ | 
|  | 160 | ((clock) < 0 ? posix_cpu_##call arglist : \ | 
|  | 161 | (posix_clocks[clock].call != NULL \ | 
|  | 162 | ? (*posix_clocks[clock].call) arglist : common_##call arglist)) | 
|  | 163 |  | 
|  | 164 | /* | 
|  | 165 | * Default clock hook functions when the struct k_clock passed | 
|  | 166 | * to register_posix_clock leaves a function pointer null. | 
|  | 167 | * | 
|  | 168 | * The function common_CALL is the default implementation for | 
|  | 169 | * the function pointer CALL in struct k_clock. | 
|  | 170 | */ | 
|  | 171 |  | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 172 | static inline int common_clock_getres(const clockid_t which_clock, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 173 | struct timespec *tp) | 
|  | 174 | { | 
|  | 175 | tp->tv_sec = 0; | 
|  | 176 | tp->tv_nsec = posix_clocks[which_clock].res; | 
|  | 177 | return 0; | 
|  | 178 | } | 
|  | 179 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 180 | /* | 
|  | 181 | * Get real time for posix timers | 
|  | 182 | */ | 
|  | 183 | static int common_clock_get(clockid_t which_clock, struct timespec *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | { | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 185 | ktime_get_real_ts(tp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 186 | return 0; | 
|  | 187 | } | 
|  | 188 |  | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 189 | static inline int common_clock_set(const clockid_t which_clock, | 
|  | 190 | struct timespec *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | { | 
|  | 192 | return do_sys_settimeofday(tp, NULL); | 
|  | 193 | } | 
|  | 194 |  | 
| Arjan van de Ven | 858119e | 2006-01-14 13:20:43 -0800 | [diff] [blame] | 195 | static int common_timer_create(struct k_itimer *new_timer) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | { | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 197 | hrtimer_init(&new_timer->it.real.timer, new_timer->it_clock, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | return 0; | 
|  | 199 | } | 
|  | 200 |  | 
|  | 201 | /* | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 202 | * Return nonzero if we know a priori this clockid_t value is bogus. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 203 | */ | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 204 | static inline int invalid_clockid(const clockid_t which_clock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | { | 
|  | 206 | if (which_clock < 0)	/* CPU clock, posix_cpu_* will check it */ | 
|  | 207 | return 0; | 
|  | 208 | if ((unsigned) which_clock >= MAX_CLOCKS) | 
|  | 209 | return 1; | 
|  | 210 | if (posix_clocks[which_clock].clock_getres != NULL) | 
|  | 211 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | if (posix_clocks[which_clock].res != 0) | 
|  | 213 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 214 | return 1; | 
|  | 215 | } | 
|  | 216 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 217 | /* | 
|  | 218 | * Get monotonic time for posix timers | 
|  | 219 | */ | 
|  | 220 | static int posix_ktime_get_ts(clockid_t which_clock, struct timespec *tp) | 
|  | 221 | { | 
|  | 222 | ktime_get_ts(tp); | 
|  | 223 | return 0; | 
|  | 224 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 |  | 
|  | 226 | /* | 
|  | 227 | * Initialize everything, well, just everything in Posix clocks/timers ;) | 
|  | 228 | */ | 
|  | 229 | static __init int init_posix_timers(void) | 
|  | 230 | { | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 231 | struct k_clock clock_realtime = { | 
|  | 232 | .clock_getres = hrtimer_get_res, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 | }; | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 234 | struct k_clock clock_monotonic = { | 
|  | 235 | .clock_getres = hrtimer_get_res, | 
|  | 236 | .clock_get = posix_ktime_get_ts, | 
|  | 237 | .clock_set = do_posix_clock_nosettime, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | }; | 
|  | 239 |  | 
|  | 240 | register_posix_clock(CLOCK_REALTIME, &clock_realtime); | 
|  | 241 | register_posix_clock(CLOCK_MONOTONIC, &clock_monotonic); | 
|  | 242 |  | 
|  | 243 | posix_timers_cache = kmem_cache_create("posix_timers_cache", | 
|  | 244 | sizeof (struct k_itimer), 0, 0, NULL, NULL); | 
|  | 245 | idr_init(&posix_timers_id); | 
|  | 246 | return 0; | 
|  | 247 | } | 
|  | 248 |  | 
|  | 249 | __initcall(init_posix_timers); | 
|  | 250 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | static void schedule_next_timer(struct k_itimer *timr) | 
|  | 252 | { | 
| Roman Zippel | 44f2147 | 2006-03-26 01:38:06 -0800 | [diff] [blame] | 253 | struct hrtimer *timer = &timr->it.real.timer; | 
|  | 254 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 255 | if (timr->it.real.interval.tv64 == 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | return; | 
|  | 257 |  | 
| Roman Zippel | 44f2147 | 2006-03-26 01:38:06 -0800 | [diff] [blame] | 258 | timr->it_overrun += hrtimer_forward(timer, timer->base->get_time(), | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 259 | timr->it.real.interval); | 
| Roman Zippel | 44f2147 | 2006-03-26 01:38:06 -0800 | [diff] [blame] | 260 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 261 | timr->it_overrun_last = timr->it_overrun; | 
|  | 262 | timr->it_overrun = -1; | 
|  | 263 | ++timr->it_requeue_pending; | 
| Roman Zippel | 44f2147 | 2006-03-26 01:38:06 -0800 | [diff] [blame] | 264 | hrtimer_restart(timer); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 265 | } | 
|  | 266 |  | 
|  | 267 | /* | 
|  | 268 | * This function is exported for use by the signal deliver code.  It is | 
|  | 269 | * called just prior to the info block being released and passes that | 
|  | 270 | * block to us.  It's function is to update the overrun entry AND to | 
|  | 271 | * restart the timer.  It should only be called if the timer is to be | 
|  | 272 | * restarted (i.e. we have flagged this in the sys_private entry of the | 
|  | 273 | * info block). | 
|  | 274 | * | 
|  | 275 | * To protect aginst the timer going away while the interrupt is queued, | 
|  | 276 | * we require that the it_requeue_pending flag be set. | 
|  | 277 | */ | 
|  | 278 | void do_schedule_next_timer(struct siginfo *info) | 
|  | 279 | { | 
|  | 280 | struct k_itimer *timr; | 
|  | 281 | unsigned long flags; | 
|  | 282 |  | 
|  | 283 | timr = lock_timer(info->si_tid, &flags); | 
|  | 284 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 285 | if (timr && timr->it_requeue_pending == info->si_sys_private) { | 
|  | 286 | if (timr->it_clock < 0) | 
|  | 287 | posix_cpu_timer_schedule(timr); | 
|  | 288 | else | 
|  | 289 | schedule_next_timer(timr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 291 | info->si_overrun = timr->it_overrun_last; | 
|  | 292 | } | 
|  | 293 |  | 
| Thomas Gleixner | b6557fb | 2006-02-01 03:05:09 -0800 | [diff] [blame] | 294 | if (timr) | 
|  | 295 | unlock_timer(timr, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | } | 
|  | 297 |  | 
|  | 298 | int posix_timer_event(struct k_itimer *timr,int si_private) | 
|  | 299 | { | 
|  | 300 | memset(&timr->sigq->info, 0, sizeof(siginfo_t)); | 
|  | 301 | timr->sigq->info.si_sys_private = si_private; | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 302 | /* Send signal to the process that owns this timer.*/ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 303 |  | 
|  | 304 | timr->sigq->info.si_signo = timr->it_sigev_signo; | 
|  | 305 | timr->sigq->info.si_errno = 0; | 
|  | 306 | timr->sigq->info.si_code = SI_TIMER; | 
|  | 307 | timr->sigq->info.si_tid = timr->it_id; | 
|  | 308 | timr->sigq->info.si_value = timr->it_sigev_value; | 
| Oleg Nesterov | e752dd6 | 2005-09-06 15:17:42 -0700 | [diff] [blame] | 309 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 310 | if (timr->it_sigev_notify & SIGEV_THREAD_ID) { | 
| Oleg Nesterov | e752dd6 | 2005-09-06 15:17:42 -0700 | [diff] [blame] | 311 | struct task_struct *leader; | 
|  | 312 | int ret = send_sigqueue(timr->it_sigev_signo, timr->sigq, | 
|  | 313 | timr->it_process); | 
|  | 314 |  | 
|  | 315 | if (likely(ret >= 0)) | 
|  | 316 | return ret; | 
|  | 317 |  | 
|  | 318 | timr->it_sigev_notify = SIGEV_SIGNAL; | 
|  | 319 | leader = timr->it_process->group_leader; | 
|  | 320 | put_task_struct(timr->it_process); | 
|  | 321 | timr->it_process = leader; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 | } | 
| Oleg Nesterov | e752dd6 | 2005-09-06 15:17:42 -0700 | [diff] [blame] | 323 |  | 
|  | 324 | return send_group_sigqueue(timr->it_sigev_signo, timr->sigq, | 
|  | 325 | timr->it_process); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | } | 
|  | 327 | EXPORT_SYMBOL_GPL(posix_timer_event); | 
|  | 328 |  | 
|  | 329 | /* | 
|  | 330 | * This function gets called when a POSIX.1b interval timer expires.  It | 
|  | 331 | * is used as a callback from the kernel internal timer.  The | 
|  | 332 | * run_timer_list code ALWAYS calls with interrupts on. | 
|  | 333 |  | 
|  | 334 | * This code is for CLOCK_REALTIME* and CLOCK_MONOTONIC* timers. | 
|  | 335 | */ | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 336 | static enum hrtimer_restart posix_timer_fn(struct hrtimer *timer) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | { | 
| Roman Zippel | 05cfb61 | 2006-03-26 01:38:12 -0800 | [diff] [blame] | 338 | struct k_itimer *timr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | unsigned long flags; | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 340 | int si_private = 0; | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 341 | enum hrtimer_restart ret = HRTIMER_NORESTART; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 |  | 
| Roman Zippel | 05cfb61 | 2006-03-26 01:38:12 -0800 | [diff] [blame] | 343 | timr = container_of(timer, struct k_itimer, it.real.timer); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 344 | spin_lock_irqsave(&timr->it_lock, flags); | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 345 |  | 
|  | 346 | if (timr->it.real.interval.tv64 != 0) | 
|  | 347 | si_private = ++timr->it_requeue_pending; | 
|  | 348 |  | 
|  | 349 | if (posix_timer_event(timr, si_private)) { | 
|  | 350 | /* | 
|  | 351 | * signal was not sent because of sig_ignor | 
|  | 352 | * we will not get a call back to restart it AND | 
|  | 353 | * it should be restarted. | 
|  | 354 | */ | 
|  | 355 | if (timr->it.real.interval.tv64 != 0) { | 
|  | 356 | timr->it_overrun += | 
| Roman Zippel | 44f2147 | 2006-03-26 01:38:06 -0800 | [diff] [blame] | 357 | hrtimer_forward(timer, | 
| Thomas Gleixner | 54cdfdb | 2007-02-16 01:28:11 -0800 | [diff] [blame] | 358 | hrtimer_cb_get_time(timer), | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 359 | timr->it.real.interval); | 
|  | 360 | ret = HRTIMER_RESTART; | 
| Roman Zippel | a0a0c28 | 2006-03-16 23:04:01 -0800 | [diff] [blame] | 361 | ++timr->it_requeue_pending; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 365 | unlock_timer(timr, flags); | 
|  | 366 | return ret; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | } | 
|  | 368 |  | 
| Arjan van de Ven | 858119e | 2006-01-14 13:20:43 -0800 | [diff] [blame] | 369 | static struct task_struct * good_sigevent(sigevent_t * event) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | { | 
|  | 371 | struct task_struct *rtn = current->group_leader; | 
|  | 372 |  | 
|  | 373 | if ((event->sigev_notify & SIGEV_THREAD_ID ) && | 
|  | 374 | (!(rtn = find_task_by_pid(event->sigev_notify_thread_id)) || | 
|  | 375 | rtn->tgid != current->tgid || | 
|  | 376 | (event->sigev_notify & ~SIGEV_THREAD_ID) != SIGEV_SIGNAL)) | 
|  | 377 | return NULL; | 
|  | 378 |  | 
|  | 379 | if (((event->sigev_notify & ~SIGEV_THREAD_ID) != SIGEV_NONE) && | 
|  | 380 | ((event->sigev_signo <= 0) || (event->sigev_signo > SIGRTMAX))) | 
|  | 381 | return NULL; | 
|  | 382 |  | 
|  | 383 | return rtn; | 
|  | 384 | } | 
|  | 385 |  | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 386 | void register_posix_clock(const clockid_t clock_id, struct k_clock *new_clock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 | { | 
|  | 388 | if ((unsigned) clock_id >= MAX_CLOCKS) { | 
|  | 389 | printk("POSIX clock register failed for clock_id %d\n", | 
|  | 390 | clock_id); | 
|  | 391 | return; | 
|  | 392 | } | 
|  | 393 |  | 
|  | 394 | posix_clocks[clock_id] = *new_clock; | 
|  | 395 | } | 
|  | 396 | EXPORT_SYMBOL_GPL(register_posix_clock); | 
|  | 397 |  | 
|  | 398 | static struct k_itimer * alloc_posix_timer(void) | 
|  | 399 | { | 
|  | 400 | struct k_itimer *tmr; | 
| Robert P. J. Day | c376222 | 2007-02-10 01:45:03 -0800 | [diff] [blame] | 401 | tmr = kmem_cache_zalloc(posix_timers_cache, GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 402 | if (!tmr) | 
|  | 403 | return tmr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | if (unlikely(!(tmr->sigq = sigqueue_alloc()))) { | 
|  | 405 | kmem_cache_free(posix_timers_cache, tmr); | 
|  | 406 | tmr = NULL; | 
|  | 407 | } | 
|  | 408 | return tmr; | 
|  | 409 | } | 
|  | 410 |  | 
|  | 411 | #define IT_ID_SET	1 | 
|  | 412 | #define IT_ID_NOT_SET	0 | 
|  | 413 | static void release_posix_timer(struct k_itimer *tmr, int it_id_set) | 
|  | 414 | { | 
|  | 415 | if (it_id_set) { | 
|  | 416 | unsigned long flags; | 
|  | 417 | spin_lock_irqsave(&idr_lock, flags); | 
|  | 418 | idr_remove(&posix_timers_id, tmr->it_id); | 
|  | 419 | spin_unlock_irqrestore(&idr_lock, flags); | 
|  | 420 | } | 
|  | 421 | sigqueue_free(tmr->sigq); | 
|  | 422 | if (unlikely(tmr->it_process) && | 
|  | 423 | tmr->it_sigev_notify == (SIGEV_SIGNAL|SIGEV_THREAD_ID)) | 
|  | 424 | put_task_struct(tmr->it_process); | 
|  | 425 | kmem_cache_free(posix_timers_cache, tmr); | 
|  | 426 | } | 
|  | 427 |  | 
|  | 428 | /* Create a POSIX.1b interval timer. */ | 
|  | 429 |  | 
|  | 430 | asmlinkage long | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 431 | sys_timer_create(const clockid_t which_clock, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 432 | struct sigevent __user *timer_event_spec, | 
|  | 433 | timer_t __user * created_timer_id) | 
|  | 434 | { | 
|  | 435 | int error = 0; | 
|  | 436 | struct k_itimer *new_timer = NULL; | 
|  | 437 | int new_timer_id; | 
|  | 438 | struct task_struct *process = NULL; | 
|  | 439 | unsigned long flags; | 
|  | 440 | sigevent_t event; | 
|  | 441 | int it_id_set = IT_ID_NOT_SET; | 
|  | 442 |  | 
|  | 443 | if (invalid_clockid(which_clock)) | 
|  | 444 | return -EINVAL; | 
|  | 445 |  | 
|  | 446 | new_timer = alloc_posix_timer(); | 
|  | 447 | if (unlikely(!new_timer)) | 
|  | 448 | return -EAGAIN; | 
|  | 449 |  | 
|  | 450 | spin_lock_init(&new_timer->it_lock); | 
|  | 451 | retry: | 
|  | 452 | if (unlikely(!idr_pre_get(&posix_timers_id, GFP_KERNEL))) { | 
|  | 453 | error = -EAGAIN; | 
|  | 454 | goto out; | 
|  | 455 | } | 
|  | 456 | spin_lock_irq(&idr_lock); | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 457 | error = idr_get_new(&posix_timers_id, (void *) new_timer, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 458 | &new_timer_id); | 
|  | 459 | spin_unlock_irq(&idr_lock); | 
|  | 460 | if (error == -EAGAIN) | 
|  | 461 | goto retry; | 
|  | 462 | else if (error) { | 
|  | 463 | /* | 
|  | 464 | * Wierd looking, but we return EAGAIN if the IDR is | 
|  | 465 | * full (proper POSIX return value for this) | 
|  | 466 | */ | 
|  | 467 | error = -EAGAIN; | 
|  | 468 | goto out; | 
|  | 469 | } | 
|  | 470 |  | 
|  | 471 | it_id_set = IT_ID_SET; | 
|  | 472 | new_timer->it_id = (timer_t) new_timer_id; | 
|  | 473 | new_timer->it_clock = which_clock; | 
|  | 474 | new_timer->it_overrun = -1; | 
|  | 475 | error = CLOCK_DISPATCH(which_clock, timer_create, (new_timer)); | 
|  | 476 | if (error) | 
|  | 477 | goto out; | 
|  | 478 |  | 
|  | 479 | /* | 
|  | 480 | * return the timer_id now.  The next step is hard to | 
|  | 481 | * back out if there is an error. | 
|  | 482 | */ | 
|  | 483 | if (copy_to_user(created_timer_id, | 
|  | 484 | &new_timer_id, sizeof (new_timer_id))) { | 
|  | 485 | error = -EFAULT; | 
|  | 486 | goto out; | 
|  | 487 | } | 
|  | 488 | if (timer_event_spec) { | 
|  | 489 | if (copy_from_user(&event, timer_event_spec, sizeof (event))) { | 
|  | 490 | error = -EFAULT; | 
|  | 491 | goto out; | 
|  | 492 | } | 
|  | 493 | new_timer->it_sigev_notify = event.sigev_notify; | 
|  | 494 | new_timer->it_sigev_signo = event.sigev_signo; | 
|  | 495 | new_timer->it_sigev_value = event.sigev_value; | 
|  | 496 |  | 
|  | 497 | read_lock(&tasklist_lock); | 
|  | 498 | if ((process = good_sigevent(&event))) { | 
|  | 499 | /* | 
|  | 500 | * We may be setting up this process for another | 
|  | 501 | * thread.  It may be exiting.  To catch this | 
|  | 502 | * case the we check the PF_EXITING flag.  If | 
|  | 503 | * the flag is not set, the siglock will catch | 
|  | 504 | * him before it is too late (in exit_itimers). | 
|  | 505 | * | 
|  | 506 | * The exec case is a bit more invloved but easy | 
|  | 507 | * to code.  If the process is in our thread | 
|  | 508 | * group (and it must be or we would not allow | 
|  | 509 | * it here) and is doing an exec, it will cause | 
|  | 510 | * us to be killed.  In this case it will wait | 
|  | 511 | * for us to die which means we can finish this | 
|  | 512 | * linkage with our last gasp. I.e. no code :) | 
|  | 513 | */ | 
|  | 514 | spin_lock_irqsave(&process->sighand->siglock, flags); | 
|  | 515 | if (!(process->flags & PF_EXITING)) { | 
|  | 516 | new_timer->it_process = process; | 
|  | 517 | list_add(&new_timer->list, | 
|  | 518 | &process->signal->posix_timers); | 
|  | 519 | spin_unlock_irqrestore(&process->sighand->siglock, flags); | 
|  | 520 | if (new_timer->it_sigev_notify == (SIGEV_SIGNAL|SIGEV_THREAD_ID)) | 
|  | 521 | get_task_struct(process); | 
|  | 522 | } else { | 
|  | 523 | spin_unlock_irqrestore(&process->sighand->siglock, flags); | 
|  | 524 | process = NULL; | 
|  | 525 | } | 
|  | 526 | } | 
|  | 527 | read_unlock(&tasklist_lock); | 
|  | 528 | if (!process) { | 
|  | 529 | error = -EINVAL; | 
|  | 530 | goto out; | 
|  | 531 | } | 
|  | 532 | } else { | 
|  | 533 | new_timer->it_sigev_notify = SIGEV_SIGNAL; | 
|  | 534 | new_timer->it_sigev_signo = SIGALRM; | 
|  | 535 | new_timer->it_sigev_value.sival_int = new_timer->it_id; | 
|  | 536 | process = current->group_leader; | 
|  | 537 | spin_lock_irqsave(&process->sighand->siglock, flags); | 
|  | 538 | new_timer->it_process = process; | 
|  | 539 | list_add(&new_timer->list, &process->signal->posix_timers); | 
|  | 540 | spin_unlock_irqrestore(&process->sighand->siglock, flags); | 
|  | 541 | } | 
|  | 542 |  | 
|  | 543 | /* | 
|  | 544 | * In the case of the timer belonging to another task, after | 
|  | 545 | * the task is unlocked, the timer is owned by the other task | 
|  | 546 | * and may cease to exist at any time.  Don't use or modify | 
|  | 547 | * new_timer after the unlock call. | 
|  | 548 | */ | 
|  | 549 |  | 
|  | 550 | out: | 
|  | 551 | if (error) | 
|  | 552 | release_posix_timer(new_timer, it_id_set); | 
|  | 553 |  | 
|  | 554 | return error; | 
|  | 555 | } | 
|  | 556 |  | 
|  | 557 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | * Locking issues: We need to protect the result of the id look up until | 
|  | 559 | * we get the timer locked down so it is not deleted under us.  The | 
|  | 560 | * removal is done under the idr spinlock so we use that here to bridge | 
|  | 561 | * the find to the timer lock.  To avoid a dead lock, the timer id MUST | 
|  | 562 | * be release with out holding the timer lock. | 
|  | 563 | */ | 
|  | 564 | static struct k_itimer * lock_timer(timer_t timer_id, unsigned long *flags) | 
|  | 565 | { | 
|  | 566 | struct k_itimer *timr; | 
|  | 567 | /* | 
|  | 568 | * Watch out here.  We do a irqsave on the idr_lock and pass the | 
|  | 569 | * flags part over to the timer lock.  Must not let interrupts in | 
|  | 570 | * while we are moving the lock. | 
|  | 571 | */ | 
|  | 572 |  | 
|  | 573 | spin_lock_irqsave(&idr_lock, *flags); | 
|  | 574 | timr = (struct k_itimer *) idr_find(&posix_timers_id, (int) timer_id); | 
|  | 575 | if (timr) { | 
|  | 576 | spin_lock(&timr->it_lock); | 
|  | 577 | spin_unlock(&idr_lock); | 
|  | 578 |  | 
|  | 579 | if ((timr->it_id != timer_id) || !(timr->it_process) || | 
|  | 580 | timr->it_process->tgid != current->tgid) { | 
|  | 581 | unlock_timer(timr, *flags); | 
|  | 582 | timr = NULL; | 
|  | 583 | } | 
|  | 584 | } else | 
|  | 585 | spin_unlock_irqrestore(&idr_lock, *flags); | 
|  | 586 |  | 
|  | 587 | return timr; | 
|  | 588 | } | 
|  | 589 |  | 
|  | 590 | /* | 
|  | 591 | * Get the time remaining on a POSIX.1b interval timer.  This function | 
|  | 592 | * is ALWAYS called with spin_lock_irq on the timer, thus it must not | 
|  | 593 | * mess with irq. | 
|  | 594 | * | 
|  | 595 | * We have a couple of messes to clean up here.  First there is the case | 
|  | 596 | * of a timer that has a requeue pending.  These timers should appear to | 
|  | 597 | * be in the timer list with an expiry as if we were to requeue them | 
|  | 598 | * now. | 
|  | 599 | * | 
|  | 600 | * The second issue is the SIGEV_NONE timer which may be active but is | 
|  | 601 | * not really ever put in the timer list (to save system resources). | 
|  | 602 | * This timer may be expired, and if so, we will do it here.  Otherwise | 
|  | 603 | * it is the same as a requeue pending timer WRT to what we should | 
|  | 604 | * report. | 
|  | 605 | */ | 
|  | 606 | static void | 
|  | 607 | common_timer_get(struct k_itimer *timr, struct itimerspec *cur_setting) | 
|  | 608 | { | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 609 | ktime_t now, remaining, iv; | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 610 | struct hrtimer *timer = &timr->it.real.timer; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 611 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 612 | memset(cur_setting, 0, sizeof(struct itimerspec)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 613 |  | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 614 | iv = timr->it.real.interval; | 
|  | 615 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 616 | /* interval timer ? */ | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 617 | if (iv.tv64) | 
|  | 618 | cur_setting->it_interval = ktime_to_timespec(iv); | 
|  | 619 | else if (!hrtimer_active(timer) && | 
|  | 620 | (timr->it_sigev_notify & ~SIGEV_THREAD_ID) != SIGEV_NONE) | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 621 | return; | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 622 |  | 
|  | 623 | now = timer->base->get_time(); | 
|  | 624 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 625 | /* | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 626 | * When a requeue is pending or this is a SIGEV_NONE | 
|  | 627 | * timer move the expiry time forward by intervals, so | 
|  | 628 | * expiry is > now. | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 629 | */ | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 630 | if (iv.tv64 && (timr->it_requeue_pending & REQUEUE_PENDING || | 
|  | 631 | (timr->it_sigev_notify & ~SIGEV_THREAD_ID) == SIGEV_NONE)) | 
|  | 632 | timr->it_overrun += hrtimer_forward(timer, now, iv); | 
|  | 633 |  | 
|  | 634 | remaining = ktime_sub(timer->expires, now); | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 635 | /* Return 0 only, when the timer is expired and not pending */ | 
| Roman Zippel | 3b98a53 | 2006-03-26 01:38:07 -0800 | [diff] [blame] | 636 | if (remaining.tv64 <= 0) { | 
|  | 637 | /* | 
|  | 638 | * A single shot SIGEV_NONE timer must return 0, when | 
|  | 639 | * it is expired ! | 
|  | 640 | */ | 
|  | 641 | if ((timr->it_sigev_notify & ~SIGEV_THREAD_ID) != SIGEV_NONE) | 
|  | 642 | cur_setting->it_value.tv_nsec = 1; | 
|  | 643 | } else | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 644 | cur_setting->it_value = ktime_to_timespec(remaining); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 | } | 
|  | 646 |  | 
|  | 647 | /* Get the time remaining on a POSIX.1b interval timer. */ | 
|  | 648 | asmlinkage long | 
|  | 649 | sys_timer_gettime(timer_t timer_id, struct itimerspec __user *setting) | 
|  | 650 | { | 
|  | 651 | struct k_itimer *timr; | 
|  | 652 | struct itimerspec cur_setting; | 
|  | 653 | unsigned long flags; | 
|  | 654 |  | 
|  | 655 | timr = lock_timer(timer_id, &flags); | 
|  | 656 | if (!timr) | 
|  | 657 | return -EINVAL; | 
|  | 658 |  | 
|  | 659 | CLOCK_DISPATCH(timr->it_clock, timer_get, (timr, &cur_setting)); | 
|  | 660 |  | 
|  | 661 | unlock_timer(timr, flags); | 
|  | 662 |  | 
|  | 663 | if (copy_to_user(setting, &cur_setting, sizeof (cur_setting))) | 
|  | 664 | return -EFAULT; | 
|  | 665 |  | 
|  | 666 | return 0; | 
|  | 667 | } | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 668 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 669 | /* | 
|  | 670 | * Get the number of overruns of a POSIX.1b interval timer.  This is to | 
|  | 671 | * be the overrun of the timer last delivered.  At the same time we are | 
|  | 672 | * accumulating overruns on the next timer.  The overrun is frozen when | 
|  | 673 | * the signal is delivered, either at the notify time (if the info block | 
|  | 674 | * is not queued) or at the actual delivery time (as we are informed by | 
|  | 675 | * the call back to do_schedule_next_timer().  So all we need to do is | 
|  | 676 | * to pick up the frozen overrun. | 
|  | 677 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | asmlinkage long | 
|  | 679 | sys_timer_getoverrun(timer_t timer_id) | 
|  | 680 | { | 
|  | 681 | struct k_itimer *timr; | 
|  | 682 | int overrun; | 
|  | 683 | long flags; | 
|  | 684 |  | 
|  | 685 | timr = lock_timer(timer_id, &flags); | 
|  | 686 | if (!timr) | 
|  | 687 | return -EINVAL; | 
|  | 688 |  | 
|  | 689 | overrun = timr->it_overrun_last; | 
|  | 690 | unlock_timer(timr, flags); | 
|  | 691 |  | 
|  | 692 | return overrun; | 
|  | 693 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 694 |  | 
|  | 695 | /* Set a POSIX.1b interval timer. */ | 
|  | 696 | /* timr->it_lock is taken. */ | 
| Arjan van de Ven | 858119e | 2006-01-14 13:20:43 -0800 | [diff] [blame] | 697 | static int | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 698 | common_timer_set(struct k_itimer *timr, int flags, | 
|  | 699 | struct itimerspec *new_setting, struct itimerspec *old_setting) | 
|  | 700 | { | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 701 | struct hrtimer *timer = &timr->it.real.timer; | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 702 | enum hrtimer_mode mode; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 |  | 
|  | 704 | if (old_setting) | 
|  | 705 | common_timer_get(timr, old_setting); | 
|  | 706 |  | 
|  | 707 | /* disable the timer */ | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 708 | timr->it.real.interval.tv64 = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 709 | /* | 
|  | 710 | * careful here.  If smp we could be in the "fire" routine which will | 
|  | 711 | * be spinning as we hold the lock.  But this is ONLY an SMP issue. | 
|  | 712 | */ | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 713 | if (hrtimer_try_to_cancel(timer) < 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 714 | return TIMER_RETRY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 715 |  | 
|  | 716 | timr->it_requeue_pending = (timr->it_requeue_pending + 2) & | 
|  | 717 | ~REQUEUE_PENDING; | 
|  | 718 | timr->it_overrun_last = 0; | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 719 |  | 
|  | 720 | /* switch off the timer when it_value is zero */ | 
|  | 721 | if (!new_setting->it_value.tv_sec && !new_setting->it_value.tv_nsec) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 723 |  | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 724 | mode = flags & TIMER_ABSTIME ? HRTIMER_MODE_ABS : HRTIMER_MODE_REL; | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 725 | hrtimer_init(&timr->it.real.timer, timr->it_clock, mode); | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 726 | timr->it.real.timer.function = posix_timer_fn; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 727 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 728 | timer->expires = timespec_to_ktime(new_setting->it_value); | 
|  | 729 |  | 
|  | 730 | /* Convert interval */ | 
|  | 731 | timr->it.real.interval = timespec_to_ktime(new_setting->it_interval); | 
|  | 732 |  | 
|  | 733 | /* SIGEV_NONE timers are not queued ! See common_timer_get */ | 
| Thomas Gleixner | 952bbc8 | 2006-02-01 03:05:13 -0800 | [diff] [blame] | 734 | if (((timr->it_sigev_notify & ~SIGEV_THREAD_ID) == SIGEV_NONE)) { | 
|  | 735 | /* Setup correct expiry time for relative timers */ | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 736 | if (mode == HRTIMER_MODE_REL) | 
| Thomas Gleixner | 952bbc8 | 2006-02-01 03:05:13 -0800 | [diff] [blame] | 737 | timer->expires = ktime_add(timer->expires, | 
|  | 738 | timer->base->get_time()); | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 739 | return 0; | 
| Thomas Gleixner | 952bbc8 | 2006-02-01 03:05:13 -0800 | [diff] [blame] | 740 | } | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 741 |  | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 742 | hrtimer_start(timer, timer->expires, mode); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 743 | return 0; | 
|  | 744 | } | 
|  | 745 |  | 
|  | 746 | /* Set a POSIX.1b interval timer */ | 
|  | 747 | asmlinkage long | 
|  | 748 | sys_timer_settime(timer_t timer_id, int flags, | 
|  | 749 | const struct itimerspec __user *new_setting, | 
|  | 750 | struct itimerspec __user *old_setting) | 
|  | 751 | { | 
|  | 752 | struct k_itimer *timr; | 
|  | 753 | struct itimerspec new_spec, old_spec; | 
|  | 754 | int error = 0; | 
|  | 755 | long flag; | 
|  | 756 | struct itimerspec *rtn = old_setting ? &old_spec : NULL; | 
|  | 757 |  | 
|  | 758 | if (!new_setting) | 
|  | 759 | return -EINVAL; | 
|  | 760 |  | 
|  | 761 | if (copy_from_user(&new_spec, new_setting, sizeof (new_spec))) | 
|  | 762 | return -EFAULT; | 
|  | 763 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 764 | if (!timespec_valid(&new_spec.it_interval) || | 
|  | 765 | !timespec_valid(&new_spec.it_value)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 766 | return -EINVAL; | 
|  | 767 | retry: | 
|  | 768 | timr = lock_timer(timer_id, &flag); | 
|  | 769 | if (!timr) | 
|  | 770 | return -EINVAL; | 
|  | 771 |  | 
|  | 772 | error = CLOCK_DISPATCH(timr->it_clock, timer_set, | 
|  | 773 | (timr, flags, &new_spec, rtn)); | 
|  | 774 |  | 
|  | 775 | unlock_timer(timr, flag); | 
|  | 776 | if (error == TIMER_RETRY) { | 
|  | 777 | rtn = NULL;	// We already got the old time... | 
|  | 778 | goto retry; | 
|  | 779 | } | 
|  | 780 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 781 | if (old_setting && !error && | 
|  | 782 | copy_to_user(old_setting, &old_spec, sizeof (old_spec))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 783 | error = -EFAULT; | 
|  | 784 |  | 
|  | 785 | return error; | 
|  | 786 | } | 
|  | 787 |  | 
|  | 788 | static inline int common_timer_del(struct k_itimer *timer) | 
|  | 789 | { | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 790 | timer->it.real.interval.tv64 = 0; | 
| Oleg Nesterov | f972be3 | 2005-06-23 00:09:00 -0700 | [diff] [blame] | 791 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 792 | if (hrtimer_try_to_cancel(&timer->it.real.timer) < 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 793 | return TIMER_RETRY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 794 | return 0; | 
|  | 795 | } | 
|  | 796 |  | 
|  | 797 | static inline int timer_delete_hook(struct k_itimer *timer) | 
|  | 798 | { | 
|  | 799 | return CLOCK_DISPATCH(timer->it_clock, timer_del, (timer)); | 
|  | 800 | } | 
|  | 801 |  | 
|  | 802 | /* Delete a POSIX.1b interval timer. */ | 
|  | 803 | asmlinkage long | 
|  | 804 | sys_timer_delete(timer_t timer_id) | 
|  | 805 | { | 
|  | 806 | struct k_itimer *timer; | 
|  | 807 | long flags; | 
|  | 808 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 809 | retry_delete: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 810 | timer = lock_timer(timer_id, &flags); | 
|  | 811 | if (!timer) | 
|  | 812 | return -EINVAL; | 
|  | 813 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 814 | if (timer_delete_hook(timer) == TIMER_RETRY) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 815 | unlock_timer(timer, flags); | 
|  | 816 | goto retry_delete; | 
|  | 817 | } | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 818 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 819 | spin_lock(¤t->sighand->siglock); | 
|  | 820 | list_del(&timer->list); | 
|  | 821 | spin_unlock(¤t->sighand->siglock); | 
|  | 822 | /* | 
|  | 823 | * This keeps any tasks waiting on the spin lock from thinking | 
|  | 824 | * they got something (see the lock code above). | 
|  | 825 | */ | 
|  | 826 | if (timer->it_process) { | 
|  | 827 | if (timer->it_sigev_notify == (SIGEV_SIGNAL|SIGEV_THREAD_ID)) | 
|  | 828 | put_task_struct(timer->it_process); | 
|  | 829 | timer->it_process = NULL; | 
|  | 830 | } | 
|  | 831 | unlock_timer(timer, flags); | 
|  | 832 | release_posix_timer(timer, IT_ID_SET); | 
|  | 833 | return 0; | 
|  | 834 | } | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 835 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 836 | /* | 
|  | 837 | * return timer owned by the process, used by exit_itimers | 
|  | 838 | */ | 
| Arjan van de Ven | 858119e | 2006-01-14 13:20:43 -0800 | [diff] [blame] | 839 | static void itimer_delete(struct k_itimer *timer) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 840 | { | 
|  | 841 | unsigned long flags; | 
|  | 842 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 843 | retry_delete: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | spin_lock_irqsave(&timer->it_lock, flags); | 
|  | 845 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 846 | if (timer_delete_hook(timer) == TIMER_RETRY) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 847 | unlock_timer(timer, flags); | 
|  | 848 | goto retry_delete; | 
|  | 849 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 850 | list_del(&timer->list); | 
|  | 851 | /* | 
|  | 852 | * This keeps any tasks waiting on the spin lock from thinking | 
|  | 853 | * they got something (see the lock code above). | 
|  | 854 | */ | 
|  | 855 | if (timer->it_process) { | 
|  | 856 | if (timer->it_sigev_notify == (SIGEV_SIGNAL|SIGEV_THREAD_ID)) | 
|  | 857 | put_task_struct(timer->it_process); | 
|  | 858 | timer->it_process = NULL; | 
|  | 859 | } | 
|  | 860 | unlock_timer(timer, flags); | 
|  | 861 | release_posix_timer(timer, IT_ID_SET); | 
|  | 862 | } | 
|  | 863 |  | 
|  | 864 | /* | 
| Roland McGrath | 25f407f | 2005-10-21 15:03:29 -0700 | [diff] [blame] | 865 | * This is called by do_exit or de_thread, only when there are no more | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 866 | * references to the shared signal_struct. | 
|  | 867 | */ | 
|  | 868 | void exit_itimers(struct signal_struct *sig) | 
|  | 869 | { | 
|  | 870 | struct k_itimer *tmr; | 
|  | 871 |  | 
|  | 872 | while (!list_empty(&sig->posix_timers)) { | 
|  | 873 | tmr = list_entry(sig->posix_timers.next, struct k_itimer, list); | 
|  | 874 | itimer_delete(tmr); | 
|  | 875 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 876 | } | 
|  | 877 |  | 
| Thomas Gleixner | becf8b5 | 2006-01-09 20:52:38 -0800 | [diff] [blame] | 878 | /* Not available / possible... functions */ | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 879 | int do_posix_clock_nosettime(const clockid_t clockid, struct timespec *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 880 | { | 
|  | 881 | return -EINVAL; | 
|  | 882 | } | 
|  | 883 | EXPORT_SYMBOL_GPL(do_posix_clock_nosettime); | 
|  | 884 |  | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 885 | int do_posix_clock_nonanosleep(const clockid_t clock, int flags, | 
| Thomas Gleixner | 97735f2 | 2006-01-09 20:52:37 -0800 | [diff] [blame] | 886 | struct timespec *t, struct timespec __user *r) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 887 | { | 
|  | 888 | #ifndef ENOTSUP | 
|  | 889 | return -EOPNOTSUPP;	/* aka ENOTSUP in userland for POSIX */ | 
|  | 890 | #else  /*  parisc does define it separately.  */ | 
|  | 891 | return -ENOTSUP; | 
|  | 892 | #endif | 
|  | 893 | } | 
|  | 894 | EXPORT_SYMBOL_GPL(do_posix_clock_nonanosleep); | 
|  | 895 |  | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 896 | asmlinkage long sys_clock_settime(const clockid_t which_clock, | 
|  | 897 | const struct timespec __user *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 898 | { | 
|  | 899 | struct timespec new_tp; | 
|  | 900 |  | 
|  | 901 | if (invalid_clockid(which_clock)) | 
|  | 902 | return -EINVAL; | 
|  | 903 | if (copy_from_user(&new_tp, tp, sizeof (*tp))) | 
|  | 904 | return -EFAULT; | 
|  | 905 |  | 
|  | 906 | return CLOCK_DISPATCH(which_clock, clock_set, (which_clock, &new_tp)); | 
|  | 907 | } | 
|  | 908 |  | 
|  | 909 | asmlinkage long | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 910 | sys_clock_gettime(const clockid_t which_clock, struct timespec __user *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 911 | { | 
|  | 912 | struct timespec kernel_tp; | 
|  | 913 | int error; | 
|  | 914 |  | 
|  | 915 | if (invalid_clockid(which_clock)) | 
|  | 916 | return -EINVAL; | 
|  | 917 | error = CLOCK_DISPATCH(which_clock, clock_get, | 
|  | 918 | (which_clock, &kernel_tp)); | 
|  | 919 | if (!error && copy_to_user(tp, &kernel_tp, sizeof (kernel_tp))) | 
|  | 920 | error = -EFAULT; | 
|  | 921 |  | 
|  | 922 | return error; | 
|  | 923 |  | 
|  | 924 | } | 
|  | 925 |  | 
|  | 926 | asmlinkage long | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 927 | sys_clock_getres(const clockid_t which_clock, struct timespec __user *tp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 928 | { | 
|  | 929 | struct timespec rtn_tp; | 
|  | 930 | int error; | 
|  | 931 |  | 
|  | 932 | if (invalid_clockid(which_clock)) | 
|  | 933 | return -EINVAL; | 
|  | 934 |  | 
|  | 935 | error = CLOCK_DISPATCH(which_clock, clock_getres, | 
|  | 936 | (which_clock, &rtn_tp)); | 
|  | 937 |  | 
|  | 938 | if (!error && tp && copy_to_user(tp, &rtn_tp, sizeof (rtn_tp))) { | 
|  | 939 | error = -EFAULT; | 
|  | 940 | } | 
|  | 941 |  | 
|  | 942 | return error; | 
|  | 943 | } | 
|  | 944 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 945 | /* | 
| Thomas Gleixner | 97735f2 | 2006-01-09 20:52:37 -0800 | [diff] [blame] | 946 | * nanosleep for monotonic and realtime clocks | 
|  | 947 | */ | 
|  | 948 | static int common_nsleep(const clockid_t which_clock, int flags, | 
|  | 949 | struct timespec *tsave, struct timespec __user *rmtp) | 
|  | 950 | { | 
| George Anzinger | 7978672 | 2006-02-01 03:05:11 -0800 | [diff] [blame] | 951 | return hrtimer_nanosleep(tsave, rmtp, flags & TIMER_ABSTIME ? | 
| Thomas Gleixner | c9cb2e3 | 2007-02-16 01:27:49 -0800 | [diff] [blame] | 952 | HRTIMER_MODE_ABS : HRTIMER_MODE_REL, | 
|  | 953 | which_clock); | 
| Thomas Gleixner | 97735f2 | 2006-01-09 20:52:37 -0800 | [diff] [blame] | 954 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 955 |  | 
|  | 956 | asmlinkage long | 
| Thomas Gleixner | a924b04 | 2006-01-09 20:52:27 -0800 | [diff] [blame] | 957 | sys_clock_nanosleep(const clockid_t which_clock, int flags, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 958 | const struct timespec __user *rqtp, | 
|  | 959 | struct timespec __user *rmtp) | 
|  | 960 | { | 
|  | 961 | struct timespec t; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 962 |  | 
|  | 963 | if (invalid_clockid(which_clock)) | 
|  | 964 | return -EINVAL; | 
|  | 965 |  | 
|  | 966 | if (copy_from_user(&t, rqtp, sizeof (struct timespec))) | 
|  | 967 | return -EFAULT; | 
|  | 968 |  | 
| Thomas Gleixner | 5f82b2b | 2006-01-09 20:52:29 -0800 | [diff] [blame] | 969 | if (!timespec_valid(&t)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 970 | return -EINVAL; | 
|  | 971 |  | 
| Thomas Gleixner | 97735f2 | 2006-01-09 20:52:37 -0800 | [diff] [blame] | 972 | return CLOCK_DISPATCH(which_clock, nsleep, | 
|  | 973 | (which_clock, flags, &t, rmtp)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 974 | } | 
| Toyo Abe | 1711ef3 | 2006-09-29 02:00:28 -0700 | [diff] [blame] | 975 |  | 
|  | 976 | /* | 
|  | 977 | * nanosleep_restart for monotonic and realtime clocks | 
|  | 978 | */ | 
|  | 979 | static int common_nsleep_restart(struct restart_block *restart_block) | 
|  | 980 | { | 
|  | 981 | return hrtimer_nanosleep_restart(restart_block); | 
|  | 982 | } | 
|  | 983 |  | 
|  | 984 | /* | 
|  | 985 | * This will restart clock_nanosleep. This is required only by | 
|  | 986 | * compat_clock_nanosleep_restart for now. | 
|  | 987 | */ | 
|  | 988 | long | 
|  | 989 | clock_nanosleep_restart(struct restart_block *restart_block) | 
|  | 990 | { | 
|  | 991 | clockid_t which_clock = restart_block->arg0; | 
|  | 992 |  | 
|  | 993 | return CLOCK_DISPATCH(which_clock, nsleep_restart, | 
|  | 994 | (restart_block)); | 
|  | 995 | } |