select.c 21.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * This file contains the procedures for the handling of select and poll
 *
 * Created for Linux based loosely upon Mathius Lattner's minix
 * patches by Peter MacDonald. Heavily edited by Linus.
 *
 *  4 February 1994
 *     COFF/ELF binary emulation. If the process has the STICKY_TIMEOUTS
 *     flag set in its personality we do *not* modify the given timeout
 *     parameter to reflect time remaining.
 *
 *  24 January 2000
 *     Changed sys_poll()/do_poll() to use PAGE_SIZE chunk-based allocation 
 *     of fds to overcome nfds < 16390 descriptors limit (Tigran Aivazian).
 */

17
#include <linux/kernel.h>
L
Linus Torvalds 已提交
18 19 20 21 22 23
#include <linux/syscalls.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/personality.h> /* for STICKY_TIMEOUTS */
#include <linux/file.h>
A
Al Viro 已提交
24
#include <linux/fdtable.h>
L
Linus Torvalds 已提交
25
#include <linux/fs.h>
26
#include <linux/rcupdate.h>
27
#include <linux/hrtimer.h>
L
Linus Torvalds 已提交
28 29 30

#include <asm/uaccess.h>

31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82

/*
 * Estimate expected accuracy in ns from a timeval.
 *
 * After quite a bit of churning around, we've settled on
 * a simple thing of taking 0.1% of the timeout as the
 * slack, with a cap of 100 msec.
 * "nice" tasks get a 0.5% slack instead.
 *
 * Consider this comment an open invitation to come up with even
 * better solutions..
 */

static unsigned long __estimate_accuracy(struct timespec *tv)
{
	unsigned long slack;
	int divfactor = 1000;

	if (task_nice(current))
		divfactor = divfactor / 5;

	slack = tv->tv_nsec / divfactor;
	slack += tv->tv_sec * (NSEC_PER_SEC/divfactor);

	if (slack > 100 * NSEC_PER_MSEC)
		slack =  100 * NSEC_PER_MSEC;
	return slack;
}

static unsigned long estimate_accuracy(struct timespec *tv)
{
	unsigned long ret;
	struct timespec now;

	/*
	 * Realtime tasks get a slack of 0 for obvious reasons.
	 */

	if (current->policy == SCHED_FIFO ||
		current->policy == SCHED_RR)
		return 0;

	ktime_get_ts(&now);
	now = timespec_sub(*tv, now);
	ret = __estimate_accuracy(&now);
	if (ret < current->timer_slack_ns)
		return current->timer_slack_ns;
	return ret;
}



L
Linus Torvalds 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103
struct poll_table_page {
	struct poll_table_page * next;
	struct poll_table_entry * entry;
	struct poll_table_entry entries[0];
};

#define POLL_TABLE_FULL(table) \
	((unsigned long)((table)->entry+1) > PAGE_SIZE + (unsigned long)(table))

/*
 * Ok, Peter made a complicated, but straightforward multiple_wait() function.
 * I have rewritten this, taking some shortcuts: This code may not be easy to
 * follow, but it should be free of race-conditions, and it's practical. If you
 * understand what I'm doing here, then you understand how the linux
 * sleep/wakeup mechanism works.
 *
 * Two very simple procedures, poll_wait() and poll_freewait() make all the
 * work.  poll_wait() is an inline-function defined in <linux/poll.h>,
 * as all select/poll functions have to call it to add an entry to the
 * poll table.
 */
A
Adrian Bunk 已提交
104 105
static void __pollwait(struct file *filp, wait_queue_head_t *wait_address,
		       poll_table *p);
L
Linus Torvalds 已提交
106 107 108 109 110 111

void poll_initwait(struct poll_wqueues *pwq)
{
	init_poll_funcptr(&pwq->pt, __pollwait);
	pwq->error = 0;
	pwq->table = NULL;
112
	pwq->inline_index = 0;
L
Linus Torvalds 已提交
113 114 115 116
}

EXPORT_SYMBOL(poll_initwait);

117 118
static void free_poll_entry(struct poll_table_entry *entry)
{
W
WANG Cong 已提交
119
	remove_wait_queue(entry->wait_address, &entry->wait);
120 121 122
	fput(entry->filp);
}

L
Linus Torvalds 已提交
123 124 125
void poll_freewait(struct poll_wqueues *pwq)
{
	struct poll_table_page * p = pwq->table;
126 127 128
	int i;
	for (i = 0; i < pwq->inline_index; i++)
		free_poll_entry(pwq->inline_entries + i);
L
Linus Torvalds 已提交
129 130 131 132 133 134 135
	while (p) {
		struct poll_table_entry * entry;
		struct poll_table_page *old;

		entry = p->entry;
		do {
			entry--;
136
			free_poll_entry(entry);
L
Linus Torvalds 已提交
137 138 139 140 141 142 143 144 145
		} while (entry > p->entries);
		old = p;
		p = p->next;
		free_page((unsigned long) old);
	}
}

EXPORT_SYMBOL(poll_freewait);

146
static struct poll_table_entry *poll_get_entry(poll_table *_p)
L
Linus Torvalds 已提交
147 148 149 150
{
	struct poll_wqueues *p = container_of(_p, struct poll_wqueues, pt);
	struct poll_table_page *table = p->table;

151 152 153
	if (p->inline_index < N_INLINE_POLL_ENTRIES)
		return p->inline_entries + p->inline_index++;

L
Linus Torvalds 已提交
154 155 156 157 158 159 160
	if (!table || POLL_TABLE_FULL(table)) {
		struct poll_table_page *new_table;

		new_table = (struct poll_table_page *) __get_free_page(GFP_KERNEL);
		if (!new_table) {
			p->error = -ENOMEM;
			__set_current_state(TASK_RUNNING);
161
			return NULL;
L
Linus Torvalds 已提交
162 163 164 165 166 167 168
		}
		new_table->entry = new_table->entries;
		new_table->next = table;
		p->table = new_table;
		table = new_table;
	}

169 170 171 172 173 174 175 176 177 178 179 180 181 182
	return table->entry++;
}

/* Add a new entry */
static void __pollwait(struct file *filp, wait_queue_head_t *wait_address,
				poll_table *p)
{
	struct poll_table_entry *entry = poll_get_entry(p);
	if (!entry)
		return;
	get_file(filp);
	entry->filp = filp;
	entry->wait_address = wait_address;
	init_waitqueue_entry(&entry->wait, current);
W
WANG Cong 已提交
183
	add_wait_queue(wait_address, &entry->wait);
L
Linus Torvalds 已提交
184 185
}

186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258
/**
 * poll_select_set_timeout - helper function to setup the timeout value
 * @to:		pointer to timespec variable for the final timeout
 * @sec:	seconds (from user space)
 * @nsec:	nanoseconds (from user space)
 *
 * Note, we do not use a timespec for the user space value here, That
 * way we can use the function for timeval and compat interfaces as well.
 *
 * Returns -EINVAL if sec/nsec are not normalized. Otherwise 0.
 */
int poll_select_set_timeout(struct timespec *to, long sec, long nsec)
{
	struct timespec ts = {.tv_sec = sec, .tv_nsec = nsec};

	if (!timespec_valid(&ts))
		return -EINVAL;

	/* Optimize for the zero timeout value here */
	if (!sec && !nsec) {
		to->tv_sec = to->tv_nsec = 0;
	} else {
		ktime_get_ts(to);
		*to = timespec_add_safe(*to, ts);
	}
	return 0;
}

static int poll_select_copy_remaining(struct timespec *end_time, void __user *p,
				      int timeval, int ret)
{
	struct timespec rts;
	struct timeval rtv;

	if (!p)
		return ret;

	if (current->personality & STICKY_TIMEOUTS)
		goto sticky;

	/* No update for zero timeout */
	if (!end_time->tv_sec && !end_time->tv_nsec)
		return ret;

	ktime_get_ts(&rts);
	rts = timespec_sub(*end_time, rts);
	if (rts.tv_sec < 0)
		rts.tv_sec = rts.tv_nsec = 0;

	if (timeval) {
		rtv.tv_sec = rts.tv_sec;
		rtv.tv_usec = rts.tv_nsec / NSEC_PER_USEC;

		if (!copy_to_user(p, &rtv, sizeof(rtv)))
			return ret;

	} else if (!copy_to_user(p, &rts, sizeof(rts)))
		return ret;

	/*
	 * If an application puts its timeval in read-only memory, we
	 * don't want the Linux-specific update to the timeval to
	 * cause a fault after the select has completed
	 * successfully. However, because we're not updating the
	 * timeval, we can't restart the system call.
	 */

sticky:
	if (ret == -ERESTARTNOHAND)
		ret = -EINTR;
	return ret;
}

L
Linus Torvalds 已提交
259 260 261 262 263 264 265 266 267 268 269
#define FDS_IN(fds, n)		(fds->in + n)
#define FDS_OUT(fds, n)		(fds->out + n)
#define FDS_EX(fds, n)		(fds->ex + n)

#define BITS(fds, n)	(*FDS_IN(fds, n)|*FDS_OUT(fds, n)|*FDS_EX(fds, n))

static int max_select_fd(unsigned long n, fd_set_bits *fds)
{
	unsigned long *open_fds;
	unsigned long set;
	int max;
270
	struct fdtable *fdt;
L
Linus Torvalds 已提交
271 272 273 274

	/* handle last in-complete long-word first */
	set = ~(~0UL << (n & (__NFDBITS-1)));
	n /= __NFDBITS;
275 276
	fdt = files_fdtable(current->files);
	open_fds = fdt->open_fds->fds_bits+n;
L
Linus Torvalds 已提交
277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310
	max = 0;
	if (set) {
		set &= BITS(fds, n);
		if (set) {
			if (!(set & ~*open_fds))
				goto get_max;
			return -EBADF;
		}
	}
	while (n) {
		open_fds--;
		n--;
		set = BITS(fds, n);
		if (!set)
			continue;
		if (set & ~*open_fds)
			return -EBADF;
		if (max)
			continue;
get_max:
		do {
			max++;
			set >>= 1;
		} while (set);
		max += n * __NFDBITS;
	}

	return max;
}

#define POLLIN_SET (POLLRDNORM | POLLRDBAND | POLLIN | POLLHUP | POLLERR)
#define POLLOUT_SET (POLLWRBAND | POLLWRNORM | POLLOUT | POLLERR)
#define POLLEX_SET (POLLPRI)

311
int do_select(int n, fd_set_bits *fds, struct timespec *end_time)
L
Linus Torvalds 已提交
312
{
313
	ktime_t expire, *to = NULL;
L
Linus Torvalds 已提交
314 315
	struct poll_wqueues table;
	poll_table *wait;
316
	int retval, i, timed_out = 0;
317
	unsigned long slack = 0;
L
Linus Torvalds 已提交
318

319
	rcu_read_lock();
L
Linus Torvalds 已提交
320
	retval = max_select_fd(n, fds);
321
	rcu_read_unlock();
L
Linus Torvalds 已提交
322 323 324 325 326 327 328

	if (retval < 0)
		return retval;
	n = retval;

	poll_initwait(&table);
	wait = &table.pt;
329
	if (end_time && !end_time->tv_sec && !end_time->tv_nsec) {
L
Linus Torvalds 已提交
330
		wait = NULL;
331 332 333
		timed_out = 1;
	}

334 335 336
	if (end_time)
		slack = estimate_accuracy(end_time);

L
Linus Torvalds 已提交
337 338 339 340 341 342 343 344 345 346 347 348
	retval = 0;
	for (;;) {
		unsigned long *rinp, *routp, *rexp, *inp, *outp, *exp;

		set_current_state(TASK_INTERRUPTIBLE);

		inp = fds->in; outp = fds->out; exp = fds->ex;
		rinp = fds->res_in; routp = fds->res_out; rexp = fds->res_ex;

		for (i = 0; i < n; ++rinp, ++routp, ++rexp) {
			unsigned long in, out, ex, all_bits, bit = 1, mask, j;
			unsigned long res_in = 0, res_out = 0, res_ex = 0;
349
			const struct file_operations *f_op = NULL;
L
Linus Torvalds 已提交
350 351 352 353 354 355 356 357 358 359
			struct file *file = NULL;

			in = *inp++; out = *outp++; ex = *exp++;
			all_bits = in | out | ex;
			if (all_bits == 0) {
				i += __NFDBITS;
				continue;
			}

			for (j = 0; j < __NFDBITS; ++j, ++i, bit <<= 1) {
360
				int fput_needed;
L
Linus Torvalds 已提交
361 362 363 364
				if (i >= n)
					break;
				if (!(bit & all_bits))
					continue;
365
				file = fget_light(i, &fput_needed);
L
Linus Torvalds 已提交
366 367 368 369 370
				if (file) {
					f_op = file->f_op;
					mask = DEFAULT_POLLMASK;
					if (f_op && f_op->poll)
						mask = (*f_op->poll)(file, retval ? NULL : wait);
371
					fput_light(file, fput_needed);
L
Linus Torvalds 已提交
372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391
					if ((mask & POLLIN_SET) && (in & bit)) {
						res_in |= bit;
						retval++;
					}
					if ((mask & POLLOUT_SET) && (out & bit)) {
						res_out |= bit;
						retval++;
					}
					if ((mask & POLLEX_SET) && (ex & bit)) {
						res_ex |= bit;
						retval++;
					}
				}
			}
			if (res_in)
				*rinp = res_in;
			if (res_out)
				*routp = res_out;
			if (res_ex)
				*rexp = res_ex;
392
			cond_resched();
L
Linus Torvalds 已提交
393 394
		}
		wait = NULL;
395
		if (retval || timed_out || signal_pending(current))
L
Linus Torvalds 已提交
396
			break;
P
Pavel Machek 已提交
397
		if (table.error) {
L
Linus Torvalds 已提交
398 399 400
			retval = table.error;
			break;
		}
401

402 403 404 405 406 407 408 409
		/*
		 * If this is the first loop and we have a timeout
		 * given, then we convert to ktime_t and set the to
		 * pointer to the expiry value.
		 */
		if (end_time && !to) {
			expire = timespec_to_ktime(*end_time);
			to = &expire;
410
		}
411

412
		if (!schedule_hrtimeout_range(to, slack, HRTIMER_MODE_ABS))
413
			timed_out = 1;
L
Linus Torvalds 已提交
414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
	}
	__set_current_state(TASK_RUNNING);

	poll_freewait(&table);

	return retval;
}

/*
 * We can actually return ERESTARTSYS instead of EINTR, but I'd
 * like to be certain this leads to no problems. So I return
 * EINTR just for safety.
 *
 * Update: ERESTARTSYS breaks at least the xview clock binary, so
 * I'm trying ERESTARTNOHAND which restart only when you want to.
 */
#define MAX_SELECT_SECONDS \
	((unsigned long) (MAX_SCHEDULE_TIMEOUT / HZ)-1)

433
int core_sys_select(int n, fd_set __user *inp, fd_set __user *outp,
434
			   fd_set __user *exp, struct timespec *end_time)
L
Linus Torvalds 已提交
435 436
{
	fd_set_bits fds;
A
Andrew Morton 已提交
437
	void *bits;
438
	int ret, max_fds;
439
	unsigned int size;
440
	struct fdtable *fdt;
441
	/* Allocate small arguments on the stack to save memory and be faster */
442
	long stack_fds[SELECT_STACK_ALLOC/sizeof(long)];
L
Linus Torvalds 已提交
443 444 445 446 447

	ret = -EINVAL;
	if (n < 0)
		goto out_nofds;

448
	/* max_fds can increase, so grab it once to avoid race */
449
	rcu_read_lock();
450
	fdt = files_fdtable(current->files);
451
	max_fds = fdt->max_fds;
452
	rcu_read_unlock();
453 454
	if (n > max_fds)
		n = max_fds;
L
Linus Torvalds 已提交
455 456 457 458 459 460 461

	/*
	 * We need 6 bitmaps (in/out/ex for both incoming and outgoing),
	 * since we used fdset we need to allocate memory in units of
	 * long-words. 
	 */
	size = FDS_BYTES(n);
462 463 464 465
	bits = stack_fds;
	if (size > sizeof(stack_fds) / 6) {
		/* Not enough space in on-stack array; must use kmalloc */
		ret = -ENOMEM;
466
		bits = kmalloc(6 * size, GFP_KERNEL);
467 468 469
		if (!bits)
			goto out_nofds;
	}
A
Andrew Morton 已提交
470 471 472 473 474 475
	fds.in      = bits;
	fds.out     = bits +   size;
	fds.ex      = bits + 2*size;
	fds.res_in  = bits + 3*size;
	fds.res_out = bits + 4*size;
	fds.res_ex  = bits + 5*size;
L
Linus Torvalds 已提交
476 477 478 479 480 481 482 483 484

	if ((ret = get_fd_set(n, inp, fds.in)) ||
	    (ret = get_fd_set(n, outp, fds.out)) ||
	    (ret = get_fd_set(n, exp, fds.ex)))
		goto out;
	zero_fd_set(n, fds.res_in);
	zero_fd_set(n, fds.res_out);
	zero_fd_set(n, fds.res_ex);

485
	ret = do_select(n, &fds, end_time);
L
Linus Torvalds 已提交
486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501

	if (ret < 0)
		goto out;
	if (!ret) {
		ret = -ERESTARTNOHAND;
		if (signal_pending(current))
			goto out;
		ret = 0;
	}

	if (set_fd_set(n, inp, fds.res_in) ||
	    set_fd_set(n, outp, fds.res_out) ||
	    set_fd_set(n, exp, fds.res_ex))
		ret = -EFAULT;

out:
502 503
	if (bits != stack_fds)
		kfree(bits);
L
Linus Torvalds 已提交
504 505 506 507
out_nofds:
	return ret;
}

508 509 510
asmlinkage long sys_select(int n, fd_set __user *inp, fd_set __user *outp,
			fd_set __user *exp, struct timeval __user *tvp)
{
511
	struct timespec end_time, *to = NULL;
512 513 514 515 516 517 518
	struct timeval tv;
	int ret;

	if (tvp) {
		if (copy_from_user(&tv, tvp, sizeof(tv)))
			return -EFAULT;

519 520 521
		to = &end_time;
		if (poll_select_set_timeout(to, tv.tv_sec,
					    tv.tv_usec * NSEC_PER_USEC))
522 523 524
			return -EINVAL;
	}

525 526
	ret = core_sys_select(n, inp, outp, exp, to);
	ret = poll_select_copy_remaining(&end_time, tvp, 1, ret);
527 528 529 530

	return ret;
}

531
#ifdef HAVE_SET_RESTORE_SIGMASK
532 533 534 535 536
asmlinkage long sys_pselect7(int n, fd_set __user *inp, fd_set __user *outp,
		fd_set __user *exp, struct timespec __user *tsp,
		const sigset_t __user *sigmask, size_t sigsetsize)
{
	sigset_t ksigmask, sigsaved;
537
	struct timespec ts, end_time, *to = NULL;
538 539 540 541 542 543
	int ret;

	if (tsp) {
		if (copy_from_user(&ts, tsp, sizeof(ts)))
			return -EFAULT;

544 545
		to = &end_time;
		if (poll_select_set_timeout(to, ts.tv_sec, ts.tv_nsec))
546 547 548 549 550 551 552 553 554 555 556 557 558 559
			return -EINVAL;
	}

	if (sigmask) {
		/* XXX: Don't preclude handling different sized sigset_t's.  */
		if (sigsetsize != sizeof(sigset_t))
			return -EINVAL;
		if (copy_from_user(&ksigmask, sigmask, sizeof(ksigmask)))
			return -EFAULT;

		sigdelsetmask(&ksigmask, sigmask(SIGKILL)|sigmask(SIGSTOP));
		sigprocmask(SIG_SETMASK, &ksigmask, &sigsaved);
	}

560 561
	ret = core_sys_select(n, inp, outp, exp, &end_time);
	ret = poll_select_copy_remaining(&end_time, tsp, 0, ret);
562 563 564 565 566 567 568 569 570 571

	if (ret == -ERESTARTNOHAND) {
		/*
		 * Don't restore the signal mask yet. Let do_signal() deliver
		 * the signal on the way back to userspace, before the signal
		 * mask is restored.
		 */
		if (sigmask) {
			memcpy(&current->saved_sigmask, &sigsaved,
					sizeof(sigsaved));
572
			set_restore_sigmask();
573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593
		}
	} else if (sigmask)
		sigprocmask(SIG_SETMASK, &sigsaved, NULL);

	return ret;
}

/*
 * Most architectures can't handle 7-argument syscalls. So we provide a
 * 6-argument version where the sixth argument is a pointer to a structure
 * which has a pointer to the sigset_t itself followed by a size_t containing
 * the sigset size.
 */
asmlinkage long sys_pselect6(int n, fd_set __user *inp, fd_set __user *outp,
	fd_set __user *exp, struct timespec __user *tsp, void __user *sig)
{
	size_t sigsetsize = 0;
	sigset_t __user *up = NULL;

	if (sig) {
		if (!access_ok(VERIFY_READ, sig, sizeof(void *)+sizeof(size_t))
594
		    || __get_user(up, (sigset_t __user * __user *)sig)
595
		    || __get_user(sigsetsize,
596
				(size_t __user *)(sig+sizeof(void *))))
597 598 599 600 601
			return -EFAULT;
	}

	return sys_pselect7(n, inp, outp, exp, tsp, up, sigsetsize);
}
602
#endif /* HAVE_SET_RESTORE_SIGMASK */
603

L
Linus Torvalds 已提交
604 605 606 607 608 609 610 611
struct poll_list {
	struct poll_list *next;
	int len;
	struct pollfd entries[0];
};

#define POLLFD_PER_PAGE  ((PAGE_SIZE-sizeof(struct poll_list)) / sizeof(struct pollfd))

612 613 614 615 616 617 618 619
/*
 * Fish for pollable events on the pollfd->fd file descriptor. We're only
 * interested in events matching the pollfd->events mask, and the result
 * matching that mask is both recorded in pollfd->revents and returned. The
 * pwait poll_table will be used by the fd-provided poll handler for waiting,
 * if non-NULL.
 */
static inline unsigned int do_pollfd(struct pollfd *pollfd, poll_table *pwait)
L
Linus Torvalds 已提交
620
{
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
	unsigned int mask;
	int fd;

	mask = 0;
	fd = pollfd->fd;
	if (fd >= 0) {
		int fput_needed;
		struct file * file;

		file = fget_light(fd, &fput_needed);
		mask = POLLNVAL;
		if (file != NULL) {
			mask = DEFAULT_POLLMASK;
			if (file->f_op && file->f_op->poll)
				mask = file->f_op->poll(file, pwait);
			/* Mask out unneeded events. */
			mask &= pollfd->events | POLLERR | POLLHUP;
			fput_light(file, fput_needed);
L
Linus Torvalds 已提交
639 640
		}
	}
641 642 643
	pollfd->revents = mask;

	return mask;
L
Linus Torvalds 已提交
644 645 646
}

static int do_poll(unsigned int nfds,  struct poll_list *list,
647
		   struct poll_wqueues *wait, struct timespec *end_time)
L
Linus Torvalds 已提交
648 649
{
	poll_table* pt = &wait->pt;
650 651
	ktime_t expire, *to = NULL;
	int timed_out = 0, count = 0;
652
	unsigned long slack = 0;
L
Linus Torvalds 已提交
653

654
	/* Optimise the no-wait case */
655
	if (end_time && !end_time->tv_sec && !end_time->tv_nsec) {
L
Linus Torvalds 已提交
656
		pt = NULL;
657 658
		timed_out = 1;
	}
659

660 661 662
	if (end_time)
		slack = estimate_accuracy(end_time);

L
Linus Torvalds 已提交
663 664
	for (;;) {
		struct poll_list *walk;
665

L
Linus Torvalds 已提交
666
		set_current_state(TASK_INTERRUPTIBLE);
667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684
		for (walk = list; walk != NULL; walk = walk->next) {
			struct pollfd * pfd, * pfd_end;

			pfd = walk->entries;
			pfd_end = pfd + walk->len;
			for (; pfd != pfd_end; pfd++) {
				/*
				 * Fish for events. If we found one, record it
				 * and kill the poll_table, so we don't
				 * needlessly register any other waiters after
				 * this. They'll get immediately deregistered
				 * when we break out and return.
				 */
				if (do_pollfd(pfd, pt)) {
					count++;
					pt = NULL;
				}
			}
L
Linus Torvalds 已提交
685
		}
686 687 688 689
		/*
		 * All waiters have already been registered, so don't provide
		 * a poll_table to them on the next loop iteration.
		 */
L
Linus Torvalds 已提交
690
		pt = NULL;
691 692 693 694 695
		if (!count) {
			count = wait->error;
			if (signal_pending(current))
				count = -EINTR;
		}
696
		if (count || timed_out)
L
Linus Torvalds 已提交
697
			break;
698

699 700 701 702 703 704 705 706
		/*
		 * If this is the first loop and we have a timeout
		 * given, then we convert to ktime_t and set the to
		 * pointer to the expiry value.
		 */
		if (end_time && !to) {
			expire = timespec_to_ktime(*end_time);
			to = &expire;
707 708
		}

709
		if (!schedule_hrtimeout_range(to, slack, HRTIMER_MODE_ABS))
710
			timed_out = 1;
L
Linus Torvalds 已提交
711 712 713 714 715
	}
	__set_current_state(TASK_RUNNING);
	return count;
}

716 717 718
#define N_STACK_PPS ((sizeof(stack_pps) - sizeof(struct poll_list))  / \
			sizeof(struct pollfd))

719 720
int do_sys_poll(struct pollfd __user *ufds, unsigned int nfds,
		struct timespec *end_time)
L
Linus Torvalds 已提交
721 722
{
	struct poll_wqueues table;
723
 	int err = -EFAULT, fdcount, len, size;
724 725 726 727
	/* Allocate small arguments on the stack to save memory and be
	   faster - use long to make sure the buffer is aligned properly
	   on 64 bit archs to avoid unaligned access */
	long stack_pps[POLL_STACK_ALLOC/sizeof(long)];
728 729 730
	struct poll_list *const head = (struct poll_list *)stack_pps;
 	struct poll_list *walk = head;
 	unsigned long todo = nfds;
L
Linus Torvalds 已提交
731

732
	if (nfds > current->signal->rlim[RLIMIT_NOFILE].rlim_cur)
L
Linus Torvalds 已提交
733 734
		return -EINVAL;

735 736 737 738 739 740
	len = min_t(unsigned int, nfds, N_STACK_PPS);
	for (;;) {
		walk->next = NULL;
		walk->len = len;
		if (!len)
			break;
L
Linus Torvalds 已提交
741

742 743 744 745 746 747 748
		if (copy_from_user(walk->entries, ufds + nfds-todo,
					sizeof(struct pollfd) * walk->len))
			goto out_fds;

		todo -= walk->len;
		if (!todo)
			break;
L
Linus Torvalds 已提交
749

750 751 752 753 754
		len = min(todo, POLLFD_PER_PAGE);
		size = sizeof(struct poll_list) + sizeof(struct pollfd) * len;
		walk = walk->next = kmalloc(size, GFP_KERNEL);
		if (!walk) {
			err = -ENOMEM;
L
Linus Torvalds 已提交
755 756 757
			goto out_fds;
		}
	}
758

759
	poll_initwait(&table);
760
	fdcount = do_poll(nfds, head, &table, end_time);
761
	poll_freewait(&table);
L
Linus Torvalds 已提交
762

763
	for (walk = head; walk; walk = walk->next) {
L
Linus Torvalds 已提交
764 765 766
		struct pollfd *fds = walk->entries;
		int j;

767 768
		for (j = 0; j < walk->len; j++, ufds++)
			if (__put_user(fds[j].revents, &ufds->revents))
L
Linus Torvalds 已提交
769 770
				goto out_fds;
  	}
771

L
Linus Torvalds 已提交
772 773
	err = fdcount;
out_fds:
774 775 776 777 778
	walk = head->next;
	while (walk) {
		struct poll_list *pos = walk;
		walk = walk->next;
		kfree(pos);
L
Linus Torvalds 已提交
779
	}
780

L
Linus Torvalds 已提交
781 782
	return err;
}
783

784 785
static long do_restart_poll(struct restart_block *restart_block)
{
786 787 788
	struct pollfd __user *ufds = restart_block->poll.ufds;
	int nfds = restart_block->poll.nfds;
	struct timespec *to = NULL, end_time;
789 790
	int ret;

791 792 793 794 795 796 797 798
	if (restart_block->poll.has_timeout) {
		end_time.tv_sec = restart_block->poll.tv_sec;
		end_time.tv_nsec = restart_block->poll.tv_nsec;
		to = &end_time;
	}

	ret = do_sys_poll(ufds, nfds, to);

799 800 801 802 803 804 805
	if (ret == -EINTR) {
		restart_block->fn = do_restart_poll;
		ret = -ERESTART_RESTARTBLOCK;
	}
	return ret;
}

806 807 808
asmlinkage long sys_poll(struct pollfd __user *ufds, unsigned int nfds,
			long timeout_msecs)
{
809
	struct timespec end_time, *to = NULL;
810
	int ret;
811

812 813 814 815
	if (timeout_msecs >= 0) {
		to = &end_time;
		poll_select_set_timeout(to, timeout_msecs / MSEC_PER_SEC,
			NSEC_PER_MSEC * (timeout_msecs % MSEC_PER_SEC));
816 817
	}

818 819
	ret = do_sys_poll(ufds, nfds, to);

820 821
	if (ret == -EINTR) {
		struct restart_block *restart_block;
822

823 824
		restart_block = &current_thread_info()->restart_block;
		restart_block->fn = do_restart_poll;
825 826 827 828 829 830 831 832 833 834
		restart_block->poll.ufds = ufds;
		restart_block->poll.nfds = nfds;

		if (timeout_msecs >= 0) {
			restart_block->poll.tv_sec = end_time.tv_sec;
			restart_block->poll.tv_nsec = end_time.tv_nsec;
			restart_block->poll.has_timeout = 1;
		} else
			restart_block->poll.has_timeout = 0;

835 836 837
		ret = -ERESTART_RESTARTBLOCK;
	}
	return ret;
838 839
}

840
#ifdef HAVE_SET_RESTORE_SIGMASK
841 842 843 844 845
asmlinkage long sys_ppoll(struct pollfd __user *ufds, unsigned int nfds,
	struct timespec __user *tsp, const sigset_t __user *sigmask,
	size_t sigsetsize)
{
	sigset_t ksigmask, sigsaved;
846
	struct timespec ts, end_time, *to = NULL;
847 848 849 850 851 852
	int ret;

	if (tsp) {
		if (copy_from_user(&ts, tsp, sizeof(ts)))
			return -EFAULT;

853 854 855
		to = &end_time;
		if (poll_select_set_timeout(to, ts.tv_sec, ts.tv_nsec))
			return -EINVAL;
856 857 858 859 860 861 862 863 864 865 866 867 868
	}

	if (sigmask) {
		/* XXX: Don't preclude handling different sized sigset_t's.  */
		if (sigsetsize != sizeof(sigset_t))
			return -EINVAL;
		if (copy_from_user(&ksigmask, sigmask, sizeof(ksigmask)))
			return -EFAULT;

		sigdelsetmask(&ksigmask, sigmask(SIGKILL)|sigmask(SIGSTOP));
		sigprocmask(SIG_SETMASK, &ksigmask, &sigsaved);
	}

869
	ret = do_sys_poll(ufds, nfds, to);
870 871 872 873 874 875 876 877 878 879 880

	/* We can restart this syscall, usually */
	if (ret == -EINTR) {
		/*
		 * Don't restore the signal mask yet. Let do_signal() deliver
		 * the signal on the way back to userspace, before the signal
		 * mask is restored.
		 */
		if (sigmask) {
			memcpy(&current->saved_sigmask, &sigsaved,
					sizeof(sigsaved));
881
			set_restore_sigmask();
882 883 884 885 886
		}
		ret = -ERESTARTNOHAND;
	} else if (sigmask)
		sigprocmask(SIG_SETMASK, &sigsaved, NULL);

887
	ret = poll_select_copy_remaining(&end_time, tsp, 0, ret);
888 889 890

	return ret;
}
891
#endif /* HAVE_SET_RESTORE_SIGMASK */