| /* | 
 |  *  fs/timerfd.c | 
 |  * | 
 |  *  Copyright (C) 2007  Davide Libenzi <davidel@xmailserver.org> | 
 |  * | 
 |  * | 
 |  *  Thanks to Thomas Gleixner for code reviews and useful comments. | 
 |  * | 
 |  */ | 
 |  | 
 | #include <linux/file.h> | 
 | #include <linux/poll.h> | 
 | #include <linux/init.h> | 
 | #include <linux/fs.h> | 
 | #include <linux/sched.h> | 
 | #include <linux/kernel.h> | 
 | #include <linux/list.h> | 
 | #include <linux/spinlock.h> | 
 | #include <linux/time.h> | 
 | #include <linux/hrtimer.h> | 
 | #include <linux/anon_inodes.h> | 
 | #include <linux/timerfd.h> | 
 | #include <linux/syscalls.h> | 
 |  | 
 | struct timerfd_ctx { | 
 | 	struct hrtimer tmr; | 
 | 	ktime_t tintv; | 
 | 	wait_queue_head_t wqh; | 
 | 	u64 ticks; | 
 | 	int expired; | 
 | 	int clockid; | 
 | }; | 
 |  | 
 | /* | 
 |  * This gets called when the timer event triggers. We set the "expired" | 
 |  * flag, but we do not re-arm the timer (in case it's necessary, | 
 |  * tintv.tv64 != 0) until the timer is accessed. | 
 |  */ | 
 | static enum hrtimer_restart timerfd_tmrproc(struct hrtimer *htmr) | 
 | { | 
 | 	struct timerfd_ctx *ctx = container_of(htmr, struct timerfd_ctx, tmr); | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&ctx->wqh.lock, flags); | 
 | 	ctx->expired = 1; | 
 | 	ctx->ticks++; | 
 | 	wake_up_locked(&ctx->wqh); | 
 | 	spin_unlock_irqrestore(&ctx->wqh.lock, flags); | 
 |  | 
 | 	return HRTIMER_NORESTART; | 
 | } | 
 |  | 
 | static ktime_t timerfd_get_remaining(struct timerfd_ctx *ctx) | 
 | { | 
 | 	ktime_t remaining; | 
 |  | 
 | 	remaining = hrtimer_expires_remaining(&ctx->tmr); | 
 | 	return remaining.tv64 < 0 ? ktime_set(0, 0): remaining; | 
 | } | 
 |  | 
 | static void timerfd_setup(struct timerfd_ctx *ctx, int flags, | 
 | 			  const struct itimerspec *ktmr) | 
 | { | 
 | 	enum hrtimer_mode htmode; | 
 | 	ktime_t texp; | 
 |  | 
 | 	htmode = (flags & TFD_TIMER_ABSTIME) ? | 
 | 		HRTIMER_MODE_ABS: HRTIMER_MODE_REL; | 
 |  | 
 | 	texp = timespec_to_ktime(ktmr->it_value); | 
 | 	ctx->expired = 0; | 
 | 	ctx->ticks = 0; | 
 | 	ctx->tintv = timespec_to_ktime(ktmr->it_interval); | 
 | 	hrtimer_init(&ctx->tmr, ctx->clockid, htmode); | 
 | 	hrtimer_set_expires(&ctx->tmr, texp); | 
 | 	ctx->tmr.function = timerfd_tmrproc; | 
 | 	if (texp.tv64 != 0) | 
 | 		hrtimer_start(&ctx->tmr, texp, htmode); | 
 | } | 
 |  | 
 | static int timerfd_release(struct inode *inode, struct file *file) | 
 | { | 
 | 	struct timerfd_ctx *ctx = file->private_data; | 
 |  | 
 | 	hrtimer_cancel(&ctx->tmr); | 
 | 	kfree(ctx); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static unsigned int timerfd_poll(struct file *file, poll_table *wait) | 
 | { | 
 | 	struct timerfd_ctx *ctx = file->private_data; | 
 | 	unsigned int events = 0; | 
 | 	unsigned long flags; | 
 |  | 
 | 	poll_wait(file, &ctx->wqh, wait); | 
 |  | 
 | 	spin_lock_irqsave(&ctx->wqh.lock, flags); | 
 | 	if (ctx->ticks) | 
 | 		events |= POLLIN; | 
 | 	spin_unlock_irqrestore(&ctx->wqh.lock, flags); | 
 |  | 
 | 	return events; | 
 | } | 
 |  | 
 | static ssize_t timerfd_read(struct file *file, char __user *buf, size_t count, | 
 | 			    loff_t *ppos) | 
 | { | 
 | 	struct timerfd_ctx *ctx = file->private_data; | 
 | 	ssize_t res; | 
 | 	u64 ticks = 0; | 
 | 	DECLARE_WAITQUEUE(wait, current); | 
 |  | 
 | 	if (count < sizeof(ticks)) | 
 | 		return -EINVAL; | 
 | 	spin_lock_irq(&ctx->wqh.lock); | 
 | 	res = -EAGAIN; | 
 | 	if (!ctx->ticks && !(file->f_flags & O_NONBLOCK)) { | 
 | 		__add_wait_queue(&ctx->wqh, &wait); | 
 | 		for (res = 0;;) { | 
 | 			set_current_state(TASK_INTERRUPTIBLE); | 
 | 			if (ctx->ticks) { | 
 | 				res = 0; | 
 | 				break; | 
 | 			} | 
 | 			if (signal_pending(current)) { | 
 | 				res = -ERESTARTSYS; | 
 | 				break; | 
 | 			} | 
 | 			spin_unlock_irq(&ctx->wqh.lock); | 
 | 			schedule(); | 
 | 			spin_lock_irq(&ctx->wqh.lock); | 
 | 		} | 
 | 		__remove_wait_queue(&ctx->wqh, &wait); | 
 | 		__set_current_state(TASK_RUNNING); | 
 | 	} | 
 | 	if (ctx->ticks) { | 
 | 		ticks = ctx->ticks; | 
 | 		if (ctx->expired && ctx->tintv.tv64) { | 
 | 			/* | 
 | 			 * If tintv.tv64 != 0, this is a periodic timer that | 
 | 			 * needs to be re-armed. We avoid doing it in the timer | 
 | 			 * callback to avoid DoS attacks specifying a very | 
 | 			 * short timer period. | 
 | 			 */ | 
 | 			ticks += hrtimer_forward_now(&ctx->tmr, | 
 | 						     ctx->tintv) - 1; | 
 | 			hrtimer_restart(&ctx->tmr); | 
 | 		} | 
 | 		ctx->expired = 0; | 
 | 		ctx->ticks = 0; | 
 | 	} | 
 | 	spin_unlock_irq(&ctx->wqh.lock); | 
 | 	if (ticks) | 
 | 		res = put_user(ticks, (u64 __user *) buf) ? -EFAULT: sizeof(ticks); | 
 | 	return res; | 
 | } | 
 |  | 
 | static const struct file_operations timerfd_fops = { | 
 | 	.release	= timerfd_release, | 
 | 	.poll		= timerfd_poll, | 
 | 	.read		= timerfd_read, | 
 | }; | 
 |  | 
 | static struct file *timerfd_fget(int fd) | 
 | { | 
 | 	struct file *file; | 
 |  | 
 | 	file = fget(fd); | 
 | 	if (!file) | 
 | 		return ERR_PTR(-EBADF); | 
 | 	if (file->f_op != &timerfd_fops) { | 
 | 		fput(file); | 
 | 		return ERR_PTR(-EINVAL); | 
 | 	} | 
 |  | 
 | 	return file; | 
 | } | 
 |  | 
 | asmlinkage long sys_timerfd_create(int clockid, int flags) | 
 | { | 
 | 	int ufd; | 
 | 	struct timerfd_ctx *ctx; | 
 |  | 
 | 	/* Check the TFD_* constants for consistency.  */ | 
 | 	BUILD_BUG_ON(TFD_CLOEXEC != O_CLOEXEC); | 
 | 	BUILD_BUG_ON(TFD_NONBLOCK != O_NONBLOCK); | 
 |  | 
 | 	if (flags & ~(TFD_CLOEXEC | TFD_NONBLOCK)) | 
 | 		return -EINVAL; | 
 | 	if (clockid != CLOCK_MONOTONIC && | 
 | 	    clockid != CLOCK_REALTIME) | 
 | 		return -EINVAL; | 
 |  | 
 | 	ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); | 
 | 	if (!ctx) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	init_waitqueue_head(&ctx->wqh); | 
 | 	ctx->clockid = clockid; | 
 | 	hrtimer_init(&ctx->tmr, clockid, HRTIMER_MODE_ABS); | 
 |  | 
 | 	ufd = anon_inode_getfd("[timerfd]", &timerfd_fops, ctx, | 
 | 			       flags & (O_CLOEXEC | O_NONBLOCK)); | 
 | 	if (ufd < 0) | 
 | 		kfree(ctx); | 
 |  | 
 | 	return ufd; | 
 | } | 
 |  | 
 | asmlinkage long sys_timerfd_settime(int ufd, int flags, | 
 | 				    const struct itimerspec __user *utmr, | 
 | 				    struct itimerspec __user *otmr) | 
 | { | 
 | 	struct file *file; | 
 | 	struct timerfd_ctx *ctx; | 
 | 	struct itimerspec ktmr, kotmr; | 
 |  | 
 | 	if (copy_from_user(&ktmr, utmr, sizeof(ktmr))) | 
 | 		return -EFAULT; | 
 |  | 
 | 	if (!timespec_valid(&ktmr.it_value) || | 
 | 	    !timespec_valid(&ktmr.it_interval)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	file = timerfd_fget(ufd); | 
 | 	if (IS_ERR(file)) | 
 | 		return PTR_ERR(file); | 
 | 	ctx = file->private_data; | 
 |  | 
 | 	/* | 
 | 	 * We need to stop the existing timer before reprogramming | 
 | 	 * it to the new values. | 
 | 	 */ | 
 | 	for (;;) { | 
 | 		spin_lock_irq(&ctx->wqh.lock); | 
 | 		if (hrtimer_try_to_cancel(&ctx->tmr) >= 0) | 
 | 			break; | 
 | 		spin_unlock_irq(&ctx->wqh.lock); | 
 | 		cpu_relax(); | 
 | 	} | 
 |  | 
 | 	/* | 
 | 	 * If the timer is expired and it's periodic, we need to advance it | 
 | 	 * because the caller may want to know the previous expiration time. | 
 | 	 * We do not update "ticks" and "expired" since the timer will be | 
 | 	 * re-programmed again in the following timerfd_setup() call. | 
 | 	 */ | 
 | 	if (ctx->expired && ctx->tintv.tv64) | 
 | 		hrtimer_forward_now(&ctx->tmr, ctx->tintv); | 
 |  | 
 | 	kotmr.it_value = ktime_to_timespec(timerfd_get_remaining(ctx)); | 
 | 	kotmr.it_interval = ktime_to_timespec(ctx->tintv); | 
 |  | 
 | 	/* | 
 | 	 * Re-program the timer to the new value ... | 
 | 	 */ | 
 | 	timerfd_setup(ctx, flags, &ktmr); | 
 |  | 
 | 	spin_unlock_irq(&ctx->wqh.lock); | 
 | 	fput(file); | 
 | 	if (otmr && copy_to_user(otmr, &kotmr, sizeof(kotmr))) | 
 | 		return -EFAULT; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | asmlinkage long sys_timerfd_gettime(int ufd, struct itimerspec __user *otmr) | 
 | { | 
 | 	struct file *file; | 
 | 	struct timerfd_ctx *ctx; | 
 | 	struct itimerspec kotmr; | 
 |  | 
 | 	file = timerfd_fget(ufd); | 
 | 	if (IS_ERR(file)) | 
 | 		return PTR_ERR(file); | 
 | 	ctx = file->private_data; | 
 |  | 
 | 	spin_lock_irq(&ctx->wqh.lock); | 
 | 	if (ctx->expired && ctx->tintv.tv64) { | 
 | 		ctx->expired = 0; | 
 | 		ctx->ticks += | 
 | 			hrtimer_forward_now(&ctx->tmr, ctx->tintv) - 1; | 
 | 		hrtimer_restart(&ctx->tmr); | 
 | 	} | 
 | 	kotmr.it_value = ktime_to_timespec(timerfd_get_remaining(ctx)); | 
 | 	kotmr.it_interval = ktime_to_timespec(ctx->tintv); | 
 | 	spin_unlock_irq(&ctx->wqh.lock); | 
 | 	fput(file); | 
 |  | 
 | 	return copy_to_user(otmr, &kotmr, sizeof(kotmr)) ? -EFAULT: 0; | 
 | } | 
 |  |