blob: a8109baa5e46429a894664eba4bfe1ce25f4b89b [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * This file contains the procedures for the handling of select and poll
3 *
4 * Created for Linux based loosely upon Mathius Lattner's minix
5 * patches by Peter MacDonald. Heavily edited by Linus.
6 *
7 * 4 February 1994
8 * COFF/ELF binary emulation. If the process has the STICKY_TIMEOUTS
9 * flag set in its personality we do *not* modify the given timeout
10 * parameter to reflect time remaining.
11 *
12 * 24 January 2000
13 * Changed sys_poll()/do_poll() to use PAGE_SIZE chunk-based allocation
14 * of fds to overcome nfds < 16390 descriptors limit (Tigran Aivazian).
15 */
16
17#include <linux/syscalls.h>
18#include <linux/module.h>
19#include <linux/slab.h>
20#include <linux/smp_lock.h>
21#include <linux/poll.h>
22#include <linux/personality.h> /* for STICKY_TIMEOUTS */
23#include <linux/file.h>
24#include <linux/fs.h>
Dipankar Sarmab8359962005-09-09 13:04:14 -070025#include <linux/rcupdate.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026
27#include <asm/uaccess.h>
28
29#define ROUND_UP(x,y) (((x)+(y)-1)/(y))
30#define DEFAULT_POLLMASK (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)
31
Linus Torvalds1da177e2005-04-16 15:20:36 -070032struct poll_table_page {
33 struct poll_table_page * next;
34 struct poll_table_entry * entry;
35 struct poll_table_entry entries[0];
36};
37
38#define POLL_TABLE_FULL(table) \
39 ((unsigned long)((table)->entry+1) > PAGE_SIZE + (unsigned long)(table))
40
41/*
42 * Ok, Peter made a complicated, but straightforward multiple_wait() function.
43 * I have rewritten this, taking some shortcuts: This code may not be easy to
44 * follow, but it should be free of race-conditions, and it's practical. If you
45 * understand what I'm doing here, then you understand how the linux
46 * sleep/wakeup mechanism works.
47 *
48 * Two very simple procedures, poll_wait() and poll_freewait() make all the
49 * work. poll_wait() is an inline-function defined in <linux/poll.h>,
50 * as all select/poll functions have to call it to add an entry to the
51 * poll table.
52 */
Adrian Bunk75c96f82005-05-05 16:16:09 -070053static void __pollwait(struct file *filp, wait_queue_head_t *wait_address,
54 poll_table *p);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
56void poll_initwait(struct poll_wqueues *pwq)
57{
58 init_poll_funcptr(&pwq->pt, __pollwait);
59 pwq->error = 0;
60 pwq->table = NULL;
Andi Kleen70674f92006-03-28 01:56:33 -080061 pwq->inline_index = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070062}
63
64EXPORT_SYMBOL(poll_initwait);
65
Andi Kleen70674f92006-03-28 01:56:33 -080066static void free_poll_entry(struct poll_table_entry *entry)
67{
68 remove_wait_queue(entry->wait_address,&entry->wait);
69 fput(entry->filp);
70}
71
Linus Torvalds1da177e2005-04-16 15:20:36 -070072void poll_freewait(struct poll_wqueues *pwq)
73{
74 struct poll_table_page * p = pwq->table;
Andi Kleen70674f92006-03-28 01:56:33 -080075 int i;
76 for (i = 0; i < pwq->inline_index; i++)
77 free_poll_entry(pwq->inline_entries + i);
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 while (p) {
79 struct poll_table_entry * entry;
80 struct poll_table_page *old;
81
82 entry = p->entry;
83 do {
84 entry--;
Andi Kleen70674f92006-03-28 01:56:33 -080085 free_poll_entry(entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 } while (entry > p->entries);
87 old = p;
88 p = p->next;
89 free_page((unsigned long) old);
90 }
91}
92
93EXPORT_SYMBOL(poll_freewait);
94
Andi Kleen70674f92006-03-28 01:56:33 -080095static struct poll_table_entry *poll_get_entry(poll_table *_p)
Linus Torvalds1da177e2005-04-16 15:20:36 -070096{
97 struct poll_wqueues *p = container_of(_p, struct poll_wqueues, pt);
98 struct poll_table_page *table = p->table;
99
Andi Kleen70674f92006-03-28 01:56:33 -0800100 if (p->inline_index < N_INLINE_POLL_ENTRIES)
101 return p->inline_entries + p->inline_index++;
102
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 if (!table || POLL_TABLE_FULL(table)) {
104 struct poll_table_page *new_table;
105
106 new_table = (struct poll_table_page *) __get_free_page(GFP_KERNEL);
107 if (!new_table) {
108 p->error = -ENOMEM;
109 __set_current_state(TASK_RUNNING);
Andi Kleen70674f92006-03-28 01:56:33 -0800110 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 }
112 new_table->entry = new_table->entries;
113 new_table->next = table;
114 p->table = new_table;
115 table = new_table;
116 }
117
Andi Kleen70674f92006-03-28 01:56:33 -0800118 return table->entry++;
119}
120
121/* Add a new entry */
122static void __pollwait(struct file *filp, wait_queue_head_t *wait_address,
123 poll_table *p)
124{
125 struct poll_table_entry *entry = poll_get_entry(p);
126 if (!entry)
127 return;
128 get_file(filp);
129 entry->filp = filp;
130 entry->wait_address = wait_address;
131 init_waitqueue_entry(&entry->wait, current);
132 add_wait_queue(wait_address,&entry->wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133}
134
135#define FDS_IN(fds, n) (fds->in + n)
136#define FDS_OUT(fds, n) (fds->out + n)
137#define FDS_EX(fds, n) (fds->ex + n)
138
139#define BITS(fds, n) (*FDS_IN(fds, n)|*FDS_OUT(fds, n)|*FDS_EX(fds, n))
140
141static int max_select_fd(unsigned long n, fd_set_bits *fds)
142{
143 unsigned long *open_fds;
144 unsigned long set;
145 int max;
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700146 struct fdtable *fdt;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147
148 /* handle last in-complete long-word first */
149 set = ~(~0UL << (n & (__NFDBITS-1)));
150 n /= __NFDBITS;
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700151 fdt = files_fdtable(current->files);
152 open_fds = fdt->open_fds->fds_bits+n;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 max = 0;
154 if (set) {
155 set &= BITS(fds, n);
156 if (set) {
157 if (!(set & ~*open_fds))
158 goto get_max;
159 return -EBADF;
160 }
161 }
162 while (n) {
163 open_fds--;
164 n--;
165 set = BITS(fds, n);
166 if (!set)
167 continue;
168 if (set & ~*open_fds)
169 return -EBADF;
170 if (max)
171 continue;
172get_max:
173 do {
174 max++;
175 set >>= 1;
176 } while (set);
177 max += n * __NFDBITS;
178 }
179
180 return max;
181}
182
183#define BIT(i) (1UL << ((i)&(__NFDBITS-1)))
184#define MEM(i,m) ((m)+(unsigned)(i)/__NFDBITS)
185#define ISSET(i,m) (((i)&*(m)) != 0)
186#define SET(i,m) (*(m) |= (i))
187
188#define POLLIN_SET (POLLRDNORM | POLLRDBAND | POLLIN | POLLHUP | POLLERR)
189#define POLLOUT_SET (POLLWRBAND | POLLWRNORM | POLLOUT | POLLERR)
190#define POLLEX_SET (POLLPRI)
191
David Woodhouse9f729492006-01-18 17:44:05 -0800192int do_select(int n, fd_set_bits *fds, s64 *timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193{
194 struct poll_wqueues table;
195 poll_table *wait;
196 int retval, i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197
Dipankar Sarmab8359962005-09-09 13:04:14 -0700198 rcu_read_lock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 retval = max_select_fd(n, fds);
Dipankar Sarmab8359962005-09-09 13:04:14 -0700200 rcu_read_unlock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201
202 if (retval < 0)
203 return retval;
204 n = retval;
205
206 poll_initwait(&table);
207 wait = &table.pt;
David Woodhouse9f729492006-01-18 17:44:05 -0800208 if (!*timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209 wait = NULL;
210 retval = 0;
211 for (;;) {
212 unsigned long *rinp, *routp, *rexp, *inp, *outp, *exp;
David Woodhouse9f729492006-01-18 17:44:05 -0800213 long __timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214
215 set_current_state(TASK_INTERRUPTIBLE);
216
217 inp = fds->in; outp = fds->out; exp = fds->ex;
218 rinp = fds->res_in; routp = fds->res_out; rexp = fds->res_ex;
219
220 for (i = 0; i < n; ++rinp, ++routp, ++rexp) {
221 unsigned long in, out, ex, all_bits, bit = 1, mask, j;
222 unsigned long res_in = 0, res_out = 0, res_ex = 0;
Arjan van de Ven99ac48f2006-03-28 01:56:41 -0800223 const struct file_operations *f_op = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 struct file *file = NULL;
225
226 in = *inp++; out = *outp++; ex = *exp++;
227 all_bits = in | out | ex;
228 if (all_bits == 0) {
229 i += __NFDBITS;
230 continue;
231 }
232
233 for (j = 0; j < __NFDBITS; ++j, ++i, bit <<= 1) {
Eric Dumazete4a1f122006-03-28 01:56:34 -0800234 int fput_needed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 if (i >= n)
236 break;
237 if (!(bit & all_bits))
238 continue;
Eric Dumazete4a1f122006-03-28 01:56:34 -0800239 file = fget_light(i, &fput_needed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 if (file) {
241 f_op = file->f_op;
242 mask = DEFAULT_POLLMASK;
243 if (f_op && f_op->poll)
244 mask = (*f_op->poll)(file, retval ? NULL : wait);
Eric Dumazete4a1f122006-03-28 01:56:34 -0800245 fput_light(file, fput_needed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246 if ((mask & POLLIN_SET) && (in & bit)) {
247 res_in |= bit;
248 retval++;
249 }
250 if ((mask & POLLOUT_SET) && (out & bit)) {
251 res_out |= bit;
252 retval++;
253 }
254 if ((mask & POLLEX_SET) && (ex & bit)) {
255 res_ex |= bit;
256 retval++;
257 }
258 }
259 cond_resched();
260 }
261 if (res_in)
262 *rinp = res_in;
263 if (res_out)
264 *routp = res_out;
265 if (res_ex)
266 *rexp = res_ex;
267 }
268 wait = NULL;
David Woodhouse9f729492006-01-18 17:44:05 -0800269 if (retval || !*timeout || signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 break;
271 if(table.error) {
272 retval = table.error;
273 break;
274 }
David Woodhouse9f729492006-01-18 17:44:05 -0800275
276 if (*timeout < 0) {
277 /* Wait indefinitely */
278 __timeout = MAX_SCHEDULE_TIMEOUT;
279 } else if (unlikely(*timeout >= (s64)MAX_SCHEDULE_TIMEOUT - 1)) {
280 /* Wait for longer than MAX_SCHEDULE_TIMEOUT. Do it in a loop */
281 __timeout = MAX_SCHEDULE_TIMEOUT - 1;
282 *timeout -= __timeout;
283 } else {
284 __timeout = *timeout;
285 *timeout = 0;
286 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 __timeout = schedule_timeout(__timeout);
David Woodhouse9f729492006-01-18 17:44:05 -0800288 if (*timeout >= 0)
289 *timeout += __timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 }
291 __set_current_state(TASK_RUNNING);
292
293 poll_freewait(&table);
294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 return retval;
296}
297
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298/*
299 * We can actually return ERESTARTSYS instead of EINTR, but I'd
300 * like to be certain this leads to no problems. So I return
301 * EINTR just for safety.
302 *
303 * Update: ERESTARTSYS breaks at least the xview clock binary, so
304 * I'm trying ERESTARTNOHAND which restart only when you want to.
305 */
306#define MAX_SELECT_SECONDS \
307 ((unsigned long) (MAX_SCHEDULE_TIMEOUT / HZ)-1)
308
David Woodhouse9f729492006-01-18 17:44:05 -0800309static int core_sys_select(int n, fd_set __user *inp, fd_set __user *outp,
310 fd_set __user *exp, s64 *timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311{
312 fd_set_bits fds;
Andrew Morton29ff2db2006-04-10 22:52:46 -0700313 void *bits;
Mitchell Blank Jrb04eb6a2006-04-10 22:54:08 -0700314 int ret, max_fdset;
315 unsigned int size;
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700316 struct fdtable *fdt;
Andi Kleen70674f92006-03-28 01:56:33 -0800317 /* Allocate small arguments on the stack to save memory and be faster */
Jes Sorensen30c14e42006-03-31 11:18:57 -0500318 long stack_fds[SELECT_STACK_ALLOC/sizeof(long)];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 ret = -EINVAL;
321 if (n < 0)
322 goto out_nofds;
323
324 /* max_fdset can increase, so grab it once to avoid race */
Dipankar Sarmab8359962005-09-09 13:04:14 -0700325 rcu_read_lock();
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700326 fdt = files_fdtable(current->files);
327 max_fdset = fdt->max_fdset;
Dipankar Sarmab8359962005-09-09 13:04:14 -0700328 rcu_read_unlock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 if (n > max_fdset)
330 n = max_fdset;
331
332 /*
333 * We need 6 bitmaps (in/out/ex for both incoming and outgoing),
334 * since we used fdset we need to allocate memory in units of
335 * long-words.
336 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 size = FDS_BYTES(n);
Mitchell Blank Jrb04eb6a2006-04-10 22:54:08 -0700338 bits = stack_fds;
339 if (size > sizeof(stack_fds) / 6) {
340 /* Not enough space in on-stack array; must use kmalloc */
341 ret = -ENOMEM;
Andi Kleen70674f92006-03-28 01:56:33 -0800342 bits = kmalloc(6 * size, GFP_KERNEL);
Mitchell Blank Jrb04eb6a2006-04-10 22:54:08 -0700343 if (!bits)
344 goto out_nofds;
345 }
Andrew Morton29ff2db2006-04-10 22:52:46 -0700346 fds.in = bits;
347 fds.out = bits + size;
348 fds.ex = bits + 2*size;
349 fds.res_in = bits + 3*size;
350 fds.res_out = bits + 4*size;
351 fds.res_ex = bits + 5*size;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352
353 if ((ret = get_fd_set(n, inp, fds.in)) ||
354 (ret = get_fd_set(n, outp, fds.out)) ||
355 (ret = get_fd_set(n, exp, fds.ex)))
356 goto out;
357 zero_fd_set(n, fds.res_in);
358 zero_fd_set(n, fds.res_out);
359 zero_fd_set(n, fds.res_ex);
360
David Woodhouse9f729492006-01-18 17:44:05 -0800361 ret = do_select(n, &fds, timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362
363 if (ret < 0)
364 goto out;
365 if (!ret) {
366 ret = -ERESTARTNOHAND;
367 if (signal_pending(current))
368 goto out;
369 ret = 0;
370 }
371
372 if (set_fd_set(n, inp, fds.res_in) ||
373 set_fd_set(n, outp, fds.res_out) ||
374 set_fd_set(n, exp, fds.res_ex))
375 ret = -EFAULT;
376
377out:
Andi Kleen70674f92006-03-28 01:56:33 -0800378 if (bits != stack_fds)
379 kfree(bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380out_nofds:
381 return ret;
382}
383
David Woodhouse9f729492006-01-18 17:44:05 -0800384asmlinkage long sys_select(int n, fd_set __user *inp, fd_set __user *outp,
385 fd_set __user *exp, struct timeval __user *tvp)
386{
387 s64 timeout = -1;
388 struct timeval tv;
389 int ret;
390
391 if (tvp) {
392 if (copy_from_user(&tv, tvp, sizeof(tv)))
393 return -EFAULT;
394
395 if (tv.tv_sec < 0 || tv.tv_usec < 0)
396 return -EINVAL;
397
398 /* Cast to u64 to make GCC stop complaining */
399 if ((u64)tv.tv_sec >= (u64)MAX_INT64_SECONDS)
400 timeout = -1; /* infinite */
401 else {
402 timeout = ROUND_UP(tv.tv_usec, USEC_PER_SEC/HZ);
403 timeout += tv.tv_sec * HZ;
404 }
405 }
406
407 ret = core_sys_select(n, inp, outp, exp, &timeout);
408
409 if (tvp) {
Andrew Morton643a6542006-02-11 17:55:52 -0800410 struct timeval rtv;
411
David Woodhouse9f729492006-01-18 17:44:05 -0800412 if (current->personality & STICKY_TIMEOUTS)
413 goto sticky;
Andrew Morton643a6542006-02-11 17:55:52 -0800414 rtv.tv_usec = jiffies_to_usecs(do_div((*(u64*)&timeout), HZ));
415 rtv.tv_sec = timeout;
Andrew Morton74910e62006-02-17 13:52:58 -0800416 if (timeval_compare(&rtv, &tv) >= 0)
Andrew Morton643a6542006-02-11 17:55:52 -0800417 rtv = tv;
418 if (copy_to_user(tvp, &rtv, sizeof(rtv))) {
David Woodhouse9f729492006-01-18 17:44:05 -0800419sticky:
420 /*
421 * If an application puts its timeval in read-only
422 * memory, we don't want the Linux-specific update to
423 * the timeval to cause a fault after the select has
424 * completed successfully. However, because we're not
425 * updating the timeval, we can't restart the system
426 * call.
427 */
428 if (ret == -ERESTARTNOHAND)
429 ret = -EINTR;
430 }
431 }
432
433 return ret;
434}
435
436#ifdef TIF_RESTORE_SIGMASK
437asmlinkage long sys_pselect7(int n, fd_set __user *inp, fd_set __user *outp,
438 fd_set __user *exp, struct timespec __user *tsp,
439 const sigset_t __user *sigmask, size_t sigsetsize)
440{
441 s64 timeout = MAX_SCHEDULE_TIMEOUT;
442 sigset_t ksigmask, sigsaved;
443 struct timespec ts;
444 int ret;
445
446 if (tsp) {
447 if (copy_from_user(&ts, tsp, sizeof(ts)))
448 return -EFAULT;
449
450 if (ts.tv_sec < 0 || ts.tv_nsec < 0)
451 return -EINVAL;
452
453 /* Cast to u64 to make GCC stop complaining */
454 if ((u64)ts.tv_sec >= (u64)MAX_INT64_SECONDS)
455 timeout = -1; /* infinite */
456 else {
457 timeout = ROUND_UP(ts.tv_nsec, NSEC_PER_SEC/HZ);
458 timeout += ts.tv_sec * HZ;
459 }
460 }
461
462 if (sigmask) {
463 /* XXX: Don't preclude handling different sized sigset_t's. */
464 if (sigsetsize != sizeof(sigset_t))
465 return -EINVAL;
466 if (copy_from_user(&ksigmask, sigmask, sizeof(ksigmask)))
467 return -EFAULT;
468
469 sigdelsetmask(&ksigmask, sigmask(SIGKILL)|sigmask(SIGSTOP));
470 sigprocmask(SIG_SETMASK, &ksigmask, &sigsaved);
471 }
472
473 ret = core_sys_select(n, inp, outp, exp, &timeout);
474
475 if (tsp) {
Andrew Morton643a6542006-02-11 17:55:52 -0800476 struct timespec rts;
477
David Woodhouse9f729492006-01-18 17:44:05 -0800478 if (current->personality & STICKY_TIMEOUTS)
479 goto sticky;
Andrew Morton643a6542006-02-11 17:55:52 -0800480 rts.tv_nsec = jiffies_to_usecs(do_div((*(u64*)&timeout), HZ)) *
481 1000;
482 rts.tv_sec = timeout;
Andrew Morton74910e62006-02-17 13:52:58 -0800483 if (timespec_compare(&rts, &ts) >= 0)
Andrew Morton643a6542006-02-11 17:55:52 -0800484 rts = ts;
485 if (copy_to_user(tsp, &rts, sizeof(rts))) {
David Woodhouse9f729492006-01-18 17:44:05 -0800486sticky:
487 /*
488 * If an application puts its timeval in read-only
489 * memory, we don't want the Linux-specific update to
490 * the timeval to cause a fault after the select has
491 * completed successfully. However, because we're not
492 * updating the timeval, we can't restart the system
493 * call.
494 */
495 if (ret == -ERESTARTNOHAND)
496 ret = -EINTR;
497 }
498 }
499
500 if (ret == -ERESTARTNOHAND) {
501 /*
502 * Don't restore the signal mask yet. Let do_signal() deliver
503 * the signal on the way back to userspace, before the signal
504 * mask is restored.
505 */
506 if (sigmask) {
507 memcpy(&current->saved_sigmask, &sigsaved,
508 sizeof(sigsaved));
509 set_thread_flag(TIF_RESTORE_SIGMASK);
510 }
511 } else if (sigmask)
512 sigprocmask(SIG_SETMASK, &sigsaved, NULL);
513
514 return ret;
515}
516
517/*
518 * Most architectures can't handle 7-argument syscalls. So we provide a
519 * 6-argument version where the sixth argument is a pointer to a structure
520 * which has a pointer to the sigset_t itself followed by a size_t containing
521 * the sigset size.
522 */
523asmlinkage long sys_pselect6(int n, fd_set __user *inp, fd_set __user *outp,
524 fd_set __user *exp, struct timespec __user *tsp, void __user *sig)
525{
526 size_t sigsetsize = 0;
527 sigset_t __user *up = NULL;
528
529 if (sig) {
530 if (!access_ok(VERIFY_READ, sig, sizeof(void *)+sizeof(size_t))
Al Viroe110ab92006-02-01 05:26:09 -0500531 || __get_user(up, (sigset_t __user * __user *)sig)
David Woodhouse9f729492006-01-18 17:44:05 -0800532 || __get_user(sigsetsize,
Al Viroe110ab92006-02-01 05:26:09 -0500533 (size_t __user *)(sig+sizeof(void *))))
David Woodhouse9f729492006-01-18 17:44:05 -0800534 return -EFAULT;
535 }
536
537 return sys_pselect7(n, inp, outp, exp, tsp, up, sigsetsize);
538}
539#endif /* TIF_RESTORE_SIGMASK */
540
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541struct poll_list {
542 struct poll_list *next;
543 int len;
544 struct pollfd entries[0];
545};
546
547#define POLLFD_PER_PAGE ((PAGE_SIZE-sizeof(struct poll_list)) / sizeof(struct pollfd))
548
549static void do_pollfd(unsigned int num, struct pollfd * fdpage,
550 poll_table ** pwait, int *count)
551{
552 int i;
553
554 for (i = 0; i < num; i++) {
555 int fd;
556 unsigned int mask;
557 struct pollfd *fdp;
558
559 mask = 0;
560 fdp = fdpage+i;
561 fd = fdp->fd;
562 if (fd >= 0) {
Eric Dumazete4a1f122006-03-28 01:56:34 -0800563 int fput_needed;
564 struct file * file = fget_light(fd, &fput_needed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 mask = POLLNVAL;
566 if (file != NULL) {
567 mask = DEFAULT_POLLMASK;
568 if (file->f_op && file->f_op->poll)
569 mask = file->f_op->poll(file, *pwait);
570 mask &= fdp->events | POLLERR | POLLHUP;
Eric Dumazete4a1f122006-03-28 01:56:34 -0800571 fput_light(file, fput_needed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 }
573 if (mask) {
574 *pwait = NULL;
575 (*count)++;
576 }
577 }
578 fdp->revents = mask;
579 }
580}
581
582static int do_poll(unsigned int nfds, struct poll_list *list,
David Woodhouse9f729492006-01-18 17:44:05 -0800583 struct poll_wqueues *wait, s64 *timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584{
585 int count = 0;
586 poll_table* pt = &wait->pt;
587
David Woodhouse9f729492006-01-18 17:44:05 -0800588 /* Optimise the no-wait case */
589 if (!(*timeout))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 pt = NULL;
591
592 for (;;) {
593 struct poll_list *walk;
David Woodhouse9f729492006-01-18 17:44:05 -0800594 long __timeout;
595
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 set_current_state(TASK_INTERRUPTIBLE);
597 walk = list;
598 while(walk != NULL) {
599 do_pollfd( walk->len, walk->entries, &pt, &count);
600 walk = walk->next;
601 }
602 pt = NULL;
David Woodhouse9f729492006-01-18 17:44:05 -0800603 if (count || !*timeout || signal_pending(current))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 break;
605 count = wait->error;
606 if (count)
607 break;
David Woodhouse9f729492006-01-18 17:44:05 -0800608
609 if (*timeout < 0) {
610 /* Wait indefinitely */
611 __timeout = MAX_SCHEDULE_TIMEOUT;
612 } else if (unlikely(*timeout >= (s64)MAX_SCHEDULE_TIMEOUT-1)) {
613 /*
614 * Wait for longer than MAX_SCHEDULE_TIMEOUT. Do it in
615 * a loop
616 */
617 __timeout = MAX_SCHEDULE_TIMEOUT - 1;
618 *timeout -= __timeout;
619 } else {
620 __timeout = *timeout;
621 *timeout = 0;
622 }
623
624 __timeout = schedule_timeout(__timeout);
625 if (*timeout >= 0)
626 *timeout += __timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 }
628 __set_current_state(TASK_RUNNING);
629 return count;
630}
631
Andi Kleen70674f92006-03-28 01:56:33 -0800632#define N_STACK_PPS ((sizeof(stack_pps) - sizeof(struct poll_list)) / \
633 sizeof(struct pollfd))
634
David Woodhouse9f729492006-01-18 17:44:05 -0800635int do_sys_poll(struct pollfd __user *ufds, unsigned int nfds, s64 *timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636{
637 struct poll_wqueues table;
638 int fdcount, err;
639 unsigned int i;
640 struct poll_list *head;
641 struct poll_list *walk;
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700642 struct fdtable *fdt;
Dipankar Sarmab8359962005-09-09 13:04:14 -0700643 int max_fdset;
Jes Sorensen30c14e42006-03-31 11:18:57 -0500644 /* Allocate small arguments on the stack to save memory and be
645 faster - use long to make sure the buffer is aligned properly
646 on 64 bit archs to avoid unaligned access */
647 long stack_pps[POLL_STACK_ALLOC/sizeof(long)];
Andi Kleen70674f92006-03-28 01:56:33 -0800648 struct poll_list *stack_pp = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649
650 /* Do a sanity check on nfds ... */
Dipankar Sarmab8359962005-09-09 13:04:14 -0700651 rcu_read_lock();
Dipankar Sarmabadf1662005-09-09 13:04:10 -0700652 fdt = files_fdtable(current->files);
Dipankar Sarmab8359962005-09-09 13:04:14 -0700653 max_fdset = fdt->max_fdset;
654 rcu_read_unlock();
655 if (nfds > max_fdset && nfds > OPEN_MAX)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 return -EINVAL;
657
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 poll_initwait(&table);
659
660 head = NULL;
661 walk = NULL;
662 i = nfds;
663 err = -ENOMEM;
664 while(i!=0) {
665 struct poll_list *pp;
Andi Kleen70674f92006-03-28 01:56:33 -0800666 int num, size;
667 if (stack_pp == NULL)
668 num = N_STACK_PPS;
669 else
670 num = POLLFD_PER_PAGE;
671 if (num > i)
672 num = i;
673 size = sizeof(struct poll_list) + sizeof(struct pollfd)*num;
674 if (!stack_pp)
675 stack_pp = pp = (struct poll_list *)stack_pps;
676 else {
677 pp = kmalloc(size, GFP_KERNEL);
678 if (!pp)
679 goto out_fds;
680 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700681 pp->next=NULL;
Andi Kleen70674f92006-03-28 01:56:33 -0800682 pp->len = num;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 if (head == NULL)
684 head = pp;
685 else
686 walk->next = pp;
687
688 walk = pp;
689 if (copy_from_user(pp->entries, ufds + nfds-i,
Andi Kleen70674f92006-03-28 01:56:33 -0800690 sizeof(struct pollfd)*num)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691 err = -EFAULT;
692 goto out_fds;
693 }
694 i -= pp->len;
695 }
David Woodhouse9f729492006-01-18 17:44:05 -0800696
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697 fdcount = do_poll(nfds, head, &table, timeout);
698
699 /* OK, now copy the revents fields back to user space. */
700 walk = head;
701 err = -EFAULT;
702 while(walk != NULL) {
703 struct pollfd *fds = walk->entries;
704 int j;
705
706 for (j=0; j < walk->len; j++, ufds++) {
707 if(__put_user(fds[j].revents, &ufds->revents))
708 goto out_fds;
709 }
710 walk = walk->next;
711 }
712 err = fdcount;
713 if (!fdcount && signal_pending(current))
714 err = -EINTR;
715out_fds:
716 walk = head;
717 while(walk!=NULL) {
718 struct poll_list *pp = walk->next;
Andi Kleen70674f92006-03-28 01:56:33 -0800719 if (walk != stack_pp)
720 kfree(walk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721 walk = pp;
722 }
723 poll_freewait(&table);
724 return err;
725}
David Woodhouse9f729492006-01-18 17:44:05 -0800726
727asmlinkage long sys_poll(struct pollfd __user *ufds, unsigned int nfds,
728 long timeout_msecs)
729{
730 s64 timeout_jiffies = 0;
731
732 if (timeout_msecs) {
733#if HZ > 1000
734 /* We can only overflow if HZ > 1000 */
735 if (timeout_msecs / 1000 > (s64)0x7fffffffffffffffULL / (s64)HZ)
736 timeout_jiffies = -1;
737 else
738#endif
739 timeout_jiffies = msecs_to_jiffies(timeout_msecs);
740 }
741
742 return do_sys_poll(ufds, nfds, &timeout_jiffies);
743}
744
745#ifdef TIF_RESTORE_SIGMASK
746asmlinkage long sys_ppoll(struct pollfd __user *ufds, unsigned int nfds,
747 struct timespec __user *tsp, const sigset_t __user *sigmask,
748 size_t sigsetsize)
749{
750 sigset_t ksigmask, sigsaved;
751 struct timespec ts;
752 s64 timeout = -1;
753 int ret;
754
755 if (tsp) {
756 if (copy_from_user(&ts, tsp, sizeof(ts)))
757 return -EFAULT;
758
759 /* Cast to u64 to make GCC stop complaining */
760 if ((u64)ts.tv_sec >= (u64)MAX_INT64_SECONDS)
761 timeout = -1; /* infinite */
762 else {
763 timeout = ROUND_UP(ts.tv_nsec, NSEC_PER_SEC/HZ);
764 timeout += ts.tv_sec * HZ;
765 }
766 }
767
768 if (sigmask) {
769 /* XXX: Don't preclude handling different sized sigset_t's. */
770 if (sigsetsize != sizeof(sigset_t))
771 return -EINVAL;
772 if (copy_from_user(&ksigmask, sigmask, sizeof(ksigmask)))
773 return -EFAULT;
774
775 sigdelsetmask(&ksigmask, sigmask(SIGKILL)|sigmask(SIGSTOP));
776 sigprocmask(SIG_SETMASK, &ksigmask, &sigsaved);
777 }
778
779 ret = do_sys_poll(ufds, nfds, &timeout);
780
781 /* We can restart this syscall, usually */
782 if (ret == -EINTR) {
783 /*
784 * Don't restore the signal mask yet. Let do_signal() deliver
785 * the signal on the way back to userspace, before the signal
786 * mask is restored.
787 */
788 if (sigmask) {
789 memcpy(&current->saved_sigmask, &sigsaved,
790 sizeof(sigsaved));
791 set_thread_flag(TIF_RESTORE_SIGMASK);
792 }
793 ret = -ERESTARTNOHAND;
794 } else if (sigmask)
795 sigprocmask(SIG_SETMASK, &sigsaved, NULL);
796
797 if (tsp && timeout >= 0) {
Andrew Morton643a6542006-02-11 17:55:52 -0800798 struct timespec rts;
799
David Woodhouse9f729492006-01-18 17:44:05 -0800800 if (current->personality & STICKY_TIMEOUTS)
801 goto sticky;
802 /* Yes, we know it's actually an s64, but it's also positive. */
Andrew Morton643a6542006-02-11 17:55:52 -0800803 rts.tv_nsec = jiffies_to_usecs(do_div((*(u64*)&timeout), HZ)) *
804 1000;
805 rts.tv_sec = timeout;
Andrew Morton74910e62006-02-17 13:52:58 -0800806 if (timespec_compare(&rts, &ts) >= 0)
Andrew Morton643a6542006-02-11 17:55:52 -0800807 rts = ts;
808 if (copy_to_user(tsp, &rts, sizeof(rts))) {
David Woodhouse9f729492006-01-18 17:44:05 -0800809 sticky:
810 /*
811 * If an application puts its timeval in read-only
812 * memory, we don't want the Linux-specific update to
813 * the timeval to cause a fault after the select has
814 * completed successfully. However, because we're not
815 * updating the timeval, we can't restart the system
816 * call.
817 */
818 if (ret == -ERESTARTNOHAND && timeout >= 0)
819 ret = -EINTR;
820 }
821 }
822
823 return ret;
824}
825#endif /* TIF_RESTORE_SIGMASK */