kernel - Fix poll return values in the presence of filter errors
[dragonfly.git] / sys / kern / sys_generic.c
1 /*
2  * Copyright (c) 1982, 1986, 1989, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  * (c) UNIX System Laboratories, Inc.
5  * All or some portions of this file are derived from material licensed
6  * to the University of California by American Telephone and Telegraph
7  * Co. or Unix System Laboratories, Inc. and are reproduced herein with
8  * the permission of UNIX System Laboratories, Inc.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. All advertising materials mentioning features or use of this software
19  *    must display the following acknowledgement:
20  *      This product includes software developed by the University of
21  *      California, Berkeley and its contributors.
22  * 4. Neither the name of the University nor the names of its contributors
23  *    may be used to endorse or promote products derived from this software
24  *    without specific prior written permission.
25  *
26  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
27  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
28  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
29  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
30  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
31  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
32  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
33  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
35  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36  * SUCH DAMAGE.
37  *
38  *      @(#)sys_generic.c       8.5 (Berkeley) 1/21/94
39  * $FreeBSD: src/sys/kern/sys_generic.c,v 1.55.2.10 2001/03/17 10:39:32 peter Exp $
40  * $DragonFly: src/sys/kern/sys_generic.c,v 1.49 2008/05/05 22:09:44 dillon Exp $
41  */
42
43 #include "opt_ktrace.h"
44
45 #include <sys/param.h>
46 #include <sys/systm.h>
47 #include <sys/sysproto.h>
48 #include <sys/event.h>
49 #include <sys/filedesc.h>
50 #include <sys/filio.h>
51 #include <sys/fcntl.h>
52 #include <sys/file.h>
53 #include <sys/proc.h>
54 #include <sys/signalvar.h>
55 #include <sys/socketvar.h>
56 #include <sys/uio.h>
57 #include <sys/kernel.h>
58 #include <sys/kern_syscall.h>
59 #include <sys/malloc.h>
60 #include <sys/mapped_ioctl.h>
61 #include <sys/poll.h>
62 #include <sys/queue.h>
63 #include <sys/resourcevar.h>
64 #include <sys/socketops.h>
65 #include <sys/sysctl.h>
66 #include <sys/sysent.h>
67 #include <sys/buf.h>
68 #ifdef KTRACE
69 #include <sys/ktrace.h>
70 #endif
71 #include <vm/vm.h>
72 #include <vm/vm_page.h>
73
74 #include <sys/file2.h>
75 #include <sys/mplock2.h>
76 #include <sys/spinlock2.h>
77
78 #include <machine/limits.h>
79
80 static MALLOC_DEFINE(M_IOCTLOPS, "ioctlops", "ioctl data buffer");
81 static MALLOC_DEFINE(M_IOCTLMAP, "ioctlmap", "mapped ioctl handler buffer");
82 static MALLOC_DEFINE(M_SELECT, "select", "select() buffer");
83 MALLOC_DEFINE(M_IOV, "iov", "large iov's");
84
85 typedef struct kfd_set {
86         fd_mask fds_bits[2];
87 } kfd_set;
88
89 enum select_copyin_states {
90     COPYIN_READ, COPYIN_WRITE, COPYIN_EXCEPT, COPYIN_DONE };
91
92 struct select_kevent_copyin_args {
93         kfd_set         *read_set;
94         kfd_set         *write_set;
95         kfd_set         *except_set;
96         int             active_set;     /* One of select_copyin_states */
97         struct lwp      *lwp;           /* Pointer to our lwp */
98         int             num_fds;        /* Number of file descriptors (syscall arg) */
99         int             proc_fds;       /* Processed fd's (wraps) */
100         int             error;          /* Returned to userland */
101 };
102
103 struct poll_kevent_copyin_args {
104         struct lwp      *lwp;
105         struct pollfd   *fds;
106         int             nfds;
107         int             pfds;
108         int             error;
109 };
110
111 static int      doselect(int nd, fd_set *in, fd_set *ou, fd_set *ex,
112                          struct timespec *ts, int *res);
113 static int      dopoll(int nfds, struct pollfd *fds, struct timespec *ts,
114                        int *res);
115 static int      dofileread(int, struct file *, struct uio *, int, size_t *);
116 static int      dofilewrite(int, struct file *, struct uio *, int, size_t *);
117
118 /*
119  * Read system call.
120  *
121  * MPSAFE
122  */
123 int
124 sys_read(struct read_args *uap)
125 {
126         struct thread *td = curthread;
127         struct uio auio;
128         struct iovec aiov;
129         int error;
130
131         if ((ssize_t)uap->nbyte < 0)
132                 error = EINVAL;
133
134         aiov.iov_base = uap->buf;
135         aiov.iov_len = uap->nbyte;
136         auio.uio_iov = &aiov;
137         auio.uio_iovcnt = 1;
138         auio.uio_offset = -1;
139         auio.uio_resid = uap->nbyte;
140         auio.uio_rw = UIO_READ;
141         auio.uio_segflg = UIO_USERSPACE;
142         auio.uio_td = td;
143
144         error = kern_preadv(uap->fd, &auio, 0, &uap->sysmsg_szresult);
145         return(error);
146 }
147
148 /*
149  * Positioned (Pread) read system call
150  *
151  * MPSAFE
152  */
153 int
154 sys_extpread(struct extpread_args *uap)
155 {
156         struct thread *td = curthread;
157         struct uio auio;
158         struct iovec aiov;
159         int error;
160         int flags;
161
162         if ((ssize_t)uap->nbyte < 0)
163                 return(EINVAL);
164
165         aiov.iov_base = uap->buf;
166         aiov.iov_len = uap->nbyte;
167         auio.uio_iov = &aiov;
168         auio.uio_iovcnt = 1;
169         auio.uio_offset = uap->offset;
170         auio.uio_resid = uap->nbyte;
171         auio.uio_rw = UIO_READ;
172         auio.uio_segflg = UIO_USERSPACE;
173         auio.uio_td = td;
174
175         flags = uap->flags & O_FMASK;
176         if (uap->offset != (off_t)-1)
177                 flags |= O_FOFFSET;
178
179         error = kern_preadv(uap->fd, &auio, flags, &uap->sysmsg_szresult);
180         return(error);
181 }
182
183 /*
184  * Scatter read system call.
185  *
186  * MPSAFE
187  */
188 int
189 sys_readv(struct readv_args *uap)
190 {
191         struct thread *td = curthread;
192         struct uio auio;
193         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
194         int error;
195
196         error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt,
197                              &auio.uio_resid);
198         if (error)
199                 return (error);
200         auio.uio_iov = iov;
201         auio.uio_iovcnt = uap->iovcnt;
202         auio.uio_offset = -1;
203         auio.uio_rw = UIO_READ;
204         auio.uio_segflg = UIO_USERSPACE;
205         auio.uio_td = td;
206
207         error = kern_preadv(uap->fd, &auio, 0, &uap->sysmsg_szresult);
208
209         iovec_free(&iov, aiov);
210         return (error);
211 }
212
213
214 /*
215  * Scatter positioned read system call.
216  *
217  * MPSAFE
218  */
219 int
220 sys_extpreadv(struct extpreadv_args *uap)
221 {
222         struct thread *td = curthread;
223         struct uio auio;
224         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
225         int error;
226         int flags;
227
228         error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt,
229                              &auio.uio_resid);
230         if (error)
231                 return (error);
232         auio.uio_iov = iov;
233         auio.uio_iovcnt = uap->iovcnt;
234         auio.uio_offset = uap->offset;
235         auio.uio_rw = UIO_READ;
236         auio.uio_segflg = UIO_USERSPACE;
237         auio.uio_td = td;
238
239         flags = uap->flags & O_FMASK;
240         if (uap->offset != (off_t)-1)
241                 flags |= O_FOFFSET;
242
243         error = kern_preadv(uap->fd, &auio, flags, &uap->sysmsg_szresult);
244
245         iovec_free(&iov, aiov);
246         return(error);
247 }
248
249 /*
250  * MPSAFE
251  */
252 int
253 kern_preadv(int fd, struct uio *auio, int flags, size_t *res)
254 {
255         struct thread *td = curthread;
256         struct proc *p = td->td_proc;
257         struct file *fp;
258         int error;
259
260         KKASSERT(p);
261
262         fp = holdfp(p->p_fd, fd, FREAD);
263         if (fp == NULL)
264                 return (EBADF);
265         if (flags & O_FOFFSET && fp->f_type != DTYPE_VNODE) {
266                 error = ESPIPE;
267         } else {
268                 error = dofileread(fd, fp, auio, flags, res);
269         }
270         fdrop(fp);
271         return(error);
272 }
273
274 /*
275  * Common code for readv and preadv that reads data in
276  * from a file using the passed in uio, offset, and flags.
277  *
278  * MPALMOSTSAFE - ktrace needs help
279  */
280 static int
281 dofileread(int fd, struct file *fp, struct uio *auio, int flags, size_t *res)
282 {
283         int error;
284         size_t len;
285 #ifdef KTRACE
286         struct thread *td = curthread;
287         struct iovec *ktriov = NULL;
288         struct uio ktruio;
289 #endif
290
291 #ifdef KTRACE
292         /*
293          * if tracing, save a copy of iovec
294          */
295         if (KTRPOINT(td, KTR_GENIO))  {
296                 int iovlen = auio->uio_iovcnt * sizeof(struct iovec);
297
298                 MALLOC(ktriov, struct iovec *, iovlen, M_TEMP, M_WAITOK);
299                 bcopy((caddr_t)auio->uio_iov, (caddr_t)ktriov, iovlen);
300                 ktruio = *auio;
301         }
302 #endif
303         len = auio->uio_resid;
304         error = fo_read(fp, auio, fp->f_cred, flags);
305         if (error) {
306                 if (auio->uio_resid != len && (error == ERESTART ||
307                     error == EINTR || error == EWOULDBLOCK))
308                         error = 0;
309         }
310 #ifdef KTRACE
311         if (ktriov != NULL) {
312                 if (error == 0) {
313                         ktruio.uio_iov = ktriov;
314                         ktruio.uio_resid = len - auio->uio_resid;
315                         get_mplock();
316                         ktrgenio(td->td_lwp, fd, UIO_READ, &ktruio, error);
317                         rel_mplock();
318                 }
319                 FREE(ktriov, M_TEMP);
320         }
321 #endif
322         if (error == 0)
323                 *res = len - auio->uio_resid;
324
325         return(error);
326 }
327
328 /*
329  * Write system call
330  *
331  * MPSAFE
332  */
333 int
334 sys_write(struct write_args *uap)
335 {
336         struct thread *td = curthread;
337         struct uio auio;
338         struct iovec aiov;
339         int error;
340
341         if ((ssize_t)uap->nbyte < 0)
342                 error = EINVAL;
343
344         aiov.iov_base = (void *)(uintptr_t)uap->buf;
345         aiov.iov_len = uap->nbyte;
346         auio.uio_iov = &aiov;
347         auio.uio_iovcnt = 1;
348         auio.uio_offset = -1;
349         auio.uio_resid = uap->nbyte;
350         auio.uio_rw = UIO_WRITE;
351         auio.uio_segflg = UIO_USERSPACE;
352         auio.uio_td = td;
353
354         error = kern_pwritev(uap->fd, &auio, 0, &uap->sysmsg_szresult);
355
356         return(error);
357 }
358
359 /*
360  * Pwrite system call
361  *
362  * MPSAFE
363  */
364 int
365 sys_extpwrite(struct extpwrite_args *uap)
366 {
367         struct thread *td = curthread;
368         struct uio auio;
369         struct iovec aiov;
370         int error;
371         int flags;
372
373         if ((ssize_t)uap->nbyte < 0)
374                 error = EINVAL;
375
376         aiov.iov_base = (void *)(uintptr_t)uap->buf;
377         aiov.iov_len = uap->nbyte;
378         auio.uio_iov = &aiov;
379         auio.uio_iovcnt = 1;
380         auio.uio_offset = uap->offset;
381         auio.uio_resid = uap->nbyte;
382         auio.uio_rw = UIO_WRITE;
383         auio.uio_segflg = UIO_USERSPACE;
384         auio.uio_td = td;
385
386         flags = uap->flags & O_FMASK;
387         if (uap->offset != (off_t)-1)
388                 flags |= O_FOFFSET;
389         error = kern_pwritev(uap->fd, &auio, flags, &uap->sysmsg_szresult);
390         return(error);
391 }
392
393 /*
394  * MPSAFE
395  */
396 int
397 sys_writev(struct writev_args *uap)
398 {
399         struct thread *td = curthread;
400         struct uio auio;
401         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
402         int error;
403
404         error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt,
405                              &auio.uio_resid);
406         if (error)
407                 return (error);
408         auio.uio_iov = iov;
409         auio.uio_iovcnt = uap->iovcnt;
410         auio.uio_offset = -1;
411         auio.uio_rw = UIO_WRITE;
412         auio.uio_segflg = UIO_USERSPACE;
413         auio.uio_td = td;
414
415         error = kern_pwritev(uap->fd, &auio, 0, &uap->sysmsg_szresult);
416
417         iovec_free(&iov, aiov);
418         return (error);
419 }
420
421
422 /*
423  * Gather positioned write system call
424  *
425  * MPSAFE
426  */
427 int
428 sys_extpwritev(struct extpwritev_args *uap)
429 {
430         struct thread *td = curthread;
431         struct uio auio;
432         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
433         int error;
434         int flags;
435
436         error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt,
437                              &auio.uio_resid);
438         if (error)
439                 return (error);
440         auio.uio_iov = iov;
441         auio.uio_iovcnt = uap->iovcnt;
442         auio.uio_offset = uap->offset;
443         auio.uio_rw = UIO_WRITE;
444         auio.uio_segflg = UIO_USERSPACE;
445         auio.uio_td = td;
446
447         flags = uap->flags & O_FMASK;
448         if (uap->offset != (off_t)-1)
449                 flags |= O_FOFFSET;
450
451         error = kern_pwritev(uap->fd, &auio, flags, &uap->sysmsg_szresult);
452
453         iovec_free(&iov, aiov);
454         return(error);
455 }
456
457 /*
458  * MPSAFE
459  */
460 int
461 kern_pwritev(int fd, struct uio *auio, int flags, size_t *res)
462 {
463         struct thread *td = curthread;
464         struct proc *p = td->td_proc;
465         struct file *fp;
466         int error;
467
468         KKASSERT(p);
469
470         fp = holdfp(p->p_fd, fd, FWRITE);
471         if (fp == NULL)
472                 return (EBADF);
473         else if ((flags & O_FOFFSET) && fp->f_type != DTYPE_VNODE) {
474                 error = ESPIPE;
475         } else {
476                 error = dofilewrite(fd, fp, auio, flags, res);
477         }
478         
479         fdrop(fp);
480         return (error);
481 }
482
483 /*
484  * Common code for writev and pwritev that writes data to
485  * a file using the passed in uio, offset, and flags.
486  *
487  * MPALMOSTSAFE - ktrace needs help
488  */
489 static int
490 dofilewrite(int fd, struct file *fp, struct uio *auio, int flags, size_t *res)
491 {       
492         struct thread *td = curthread;
493         struct lwp *lp = td->td_lwp;
494         int error;
495         size_t len;
496 #ifdef KTRACE
497         struct iovec *ktriov = NULL;
498         struct uio ktruio;
499 #endif
500
501 #ifdef KTRACE
502         /*
503          * if tracing, save a copy of iovec and uio
504          */
505         if (KTRPOINT(td, KTR_GENIO))  {
506                 int iovlen = auio->uio_iovcnt * sizeof(struct iovec);
507
508                 MALLOC(ktriov, struct iovec *, iovlen, M_TEMP, M_WAITOK);
509                 bcopy((caddr_t)auio->uio_iov, (caddr_t)ktriov, iovlen);
510                 ktruio = *auio;
511         }
512 #endif
513         len = auio->uio_resid;
514         error = fo_write(fp, auio, fp->f_cred, flags);
515         if (error) {
516                 if (auio->uio_resid != len && (error == ERESTART ||
517                     error == EINTR || error == EWOULDBLOCK))
518                         error = 0;
519                 /* Socket layer is responsible for issuing SIGPIPE. */
520                 if (error == EPIPE) {
521                         get_mplock();
522                         lwpsignal(lp->lwp_proc, lp, SIGPIPE);
523                         rel_mplock();
524                 }
525         }
526 #ifdef KTRACE
527         if (ktriov != NULL) {
528                 if (error == 0) {
529                         ktruio.uio_iov = ktriov;
530                         ktruio.uio_resid = len - auio->uio_resid;
531                         get_mplock();
532                         ktrgenio(lp, fd, UIO_WRITE, &ktruio, error);
533                         rel_mplock();
534                 }
535                 FREE(ktriov, M_TEMP);
536         }
537 #endif
538         if (error == 0)
539                 *res = len - auio->uio_resid;
540
541         return(error);
542 }
543
544 /*
545  * Ioctl system call
546  *
547  * MPALMOSTSAFE
548  */
549 int
550 sys_ioctl(struct ioctl_args *uap)
551 {
552         int error;
553
554         get_mplock();
555         error = mapped_ioctl(uap->fd, uap->com, uap->data, NULL, &uap->sysmsg);
556         rel_mplock();
557         return (error);
558 }
559
560 struct ioctl_map_entry {
561         const char *subsys;
562         struct ioctl_map_range *cmd_ranges;
563         LIST_ENTRY(ioctl_map_entry) entries;
564 };
565
566 /*
567  * The true heart of all ioctl syscall handlers (native, emulation).
568  * If map != NULL, it will be searched for a matching entry for com,
569  * and appropriate conversions/conversion functions will be utilized.
570  */
571 int
572 mapped_ioctl(int fd, u_long com, caddr_t uspc_data, struct ioctl_map *map,
573              struct sysmsg *msg)
574 {
575         struct thread *td = curthread;
576         struct proc *p = td->td_proc;
577         struct ucred *cred;
578         struct file *fp;
579         struct ioctl_map_range *iomc = NULL;
580         int error;
581         u_int size;
582         u_long ocom = com;
583         caddr_t data, memp;
584         int tmp;
585 #define STK_PARAMS      128
586         union {
587             char stkbuf[STK_PARAMS];
588             long align;
589         } ubuf;
590
591         KKASSERT(p);
592         cred = td->td_ucred;
593
594         fp = holdfp(p->p_fd, fd, FREAD|FWRITE);
595         if (fp == NULL)
596                 return(EBADF);
597
598         if (map != NULL) {      /* obey translation map */
599                 u_long maskcmd;
600                 struct ioctl_map_entry *e;
601
602                 maskcmd = com & map->mask;
603
604                 LIST_FOREACH(e, &map->mapping, entries) {
605                         for (iomc = e->cmd_ranges; iomc->start != 0 ||
606                              iomc->maptocmd != 0 || iomc->wrapfunc != NULL ||
607                              iomc->mapfunc != NULL;
608                              iomc++) {
609                                 if (maskcmd >= iomc->start &&
610                                     maskcmd <= iomc->end)
611                                         break;
612                         }
613
614                         /* Did we find a match? */
615                         if (iomc->start != 0 || iomc->maptocmd != 0 ||
616                             iomc->wrapfunc != NULL || iomc->mapfunc != NULL)
617                                 break;
618                 }
619
620                 if (iomc == NULL ||
621                     (iomc->start == 0 && iomc->maptocmd == 0
622                      && iomc->wrapfunc == NULL && iomc->mapfunc == NULL)) {
623                         kprintf("%s: 'ioctl' fd=%d, cmd=0x%lx ('%c',%d) not implemented\n",
624                                map->sys, fd, maskcmd,
625                                (int)((maskcmd >> 8) & 0xff),
626                                (int)(maskcmd & 0xff));
627                         error = EINVAL;
628                         goto done;
629                 }
630
631                 /*
632                  * If it's a non-range one to one mapping, maptocmd should be
633                  * correct. If it's a ranged one to one mapping, we pass the
634                  * original value of com, and for a range mapped to a different
635                  * range, we always need a mapping function to translate the
636                  * ioctl to our native ioctl. Ex. 6500-65ff <-> 9500-95ff
637                  */
638                 if (iomc->start == iomc->end && iomc->maptocmd == iomc->maptoend) {
639                         com = iomc->maptocmd;
640                 } else if (iomc->start == iomc->maptocmd && iomc->end == iomc->maptoend) {
641                         if (iomc->mapfunc != NULL)
642                                 com = iomc->mapfunc(iomc->start, iomc->end,
643                                                     iomc->start, iomc->end,
644                                                     com, com);
645                 } else {
646                         if (iomc->mapfunc != NULL) {
647                                 com = iomc->mapfunc(iomc->start, iomc->end,
648                                                     iomc->maptocmd, iomc->maptoend,
649                                                     com, ocom);
650                         } else {
651                                 kprintf("%s: Invalid mapping for fd=%d, cmd=%#lx ('%c',%d)\n",
652                                        map->sys, fd, maskcmd,
653                                        (int)((maskcmd >> 8) & 0xff),
654                                        (int)(maskcmd & 0xff));
655                                 error = EINVAL;
656                                 goto done;
657                         }
658                 }
659         }
660
661         switch (com) {
662         case FIONCLEX:
663                 error = fclrfdflags(p->p_fd, fd, UF_EXCLOSE);
664                 goto done;
665         case FIOCLEX:
666                 error = fsetfdflags(p->p_fd, fd, UF_EXCLOSE);
667                 goto done;
668         }
669
670         /*
671          * Interpret high order word to find amount of data to be
672          * copied to/from the user's address space.
673          */
674         size = IOCPARM_LEN(com);
675         if (size > IOCPARM_MAX) {
676                 error = ENOTTY;
677                 goto done;
678         }
679
680         memp = NULL;
681         if (size > sizeof (ubuf.stkbuf)) {
682                 memp = kmalloc(size, M_IOCTLOPS, M_WAITOK);
683                 data = memp;
684         } else {
685                 data = ubuf.stkbuf;
686         }
687         if ((com & IOC_IN) != 0) {
688                 if (size != 0) {
689                         error = copyin(uspc_data, data, (size_t)size);
690                         if (error) {
691                                 if (memp != NULL)
692                                         kfree(memp, M_IOCTLOPS);
693                                 goto done;
694                         }
695                 } else {
696                         *(caddr_t *)data = uspc_data;
697                 }
698         } else if ((com & IOC_OUT) != 0 && size) {
699                 /*
700                  * Zero the buffer so the user always
701                  * gets back something deterministic.
702                  */
703                 bzero(data, (size_t)size);
704         } else if ((com & IOC_VOID) != 0) {
705                 *(caddr_t *)data = uspc_data;
706         }
707
708         switch (com) {
709         case FIONBIO:
710                 if ((tmp = *(int *)data))
711                         fp->f_flag |= FNONBLOCK;
712                 else
713                         fp->f_flag &= ~FNONBLOCK;
714                 error = 0;
715                 break;
716
717         case FIOASYNC:
718                 if ((tmp = *(int *)data))
719                         fp->f_flag |= FASYNC;
720                 else
721                         fp->f_flag &= ~FASYNC;
722                 error = fo_ioctl(fp, FIOASYNC, (caddr_t)&tmp, cred, msg);
723                 break;
724
725         default:
726                 /*
727                  *  If there is a override function,
728                  *  call it instead of directly routing the call
729                  */
730                 if (map != NULL && iomc->wrapfunc != NULL)
731                         error = iomc->wrapfunc(fp, com, ocom, data, cred);
732                 else
733                         error = fo_ioctl(fp, com, data, cred, msg);
734                 /*
735                  * Copy any data to user, size was
736                  * already set and checked above.
737                  */
738                 if (error == 0 && (com & IOC_OUT) != 0 && size != 0)
739                         error = copyout(data, uspc_data, (size_t)size);
740                 break;
741         }
742         if (memp != NULL)
743                 kfree(memp, M_IOCTLOPS);
744 done:
745         fdrop(fp);
746         return(error);
747 }
748
749 int
750 mapped_ioctl_register_handler(struct ioctl_map_handler *he)
751 {
752         struct ioctl_map_entry *ne;
753
754         KKASSERT(he != NULL && he->map != NULL && he->cmd_ranges != NULL &&
755                  he->subsys != NULL && *he->subsys != '\0');
756
757         ne = kmalloc(sizeof(struct ioctl_map_entry), M_IOCTLMAP, M_WAITOK);
758
759         ne->subsys = he->subsys;
760         ne->cmd_ranges = he->cmd_ranges;
761
762         LIST_INSERT_HEAD(&he->map->mapping, ne, entries);
763
764         return(0);
765 }
766
767 int
768 mapped_ioctl_unregister_handler(struct ioctl_map_handler *he)
769 {
770         struct ioctl_map_entry *ne;
771
772         KKASSERT(he != NULL && he->map != NULL && he->cmd_ranges != NULL);
773
774         LIST_FOREACH(ne, &he->map->mapping, entries) {
775                 if (ne->cmd_ranges != he->cmd_ranges)
776                         continue;
777                 LIST_REMOVE(ne, entries);
778                 kfree(ne, M_IOCTLMAP);
779                 return(0);
780         }
781         return(EINVAL);
782 }
783
784 static int      nselcoll;       /* Select collisions since boot */
785 int     selwait;
786 SYSCTL_INT(_kern, OID_AUTO, nselcoll, CTLFLAG_RD, &nselcoll, 0, "");
787 static int      nseldebug;
788 SYSCTL_INT(_kern, OID_AUTO, nseldebug, CTLFLAG_RW, &nseldebug, 0, "");
789
790 /*
791  * Select system call.
792  *
793  * MPSAFE
794  */
795 int
796 sys_select(struct select_args *uap)
797 {
798         struct timeval ktv;
799         struct timespec *ktsp, kts;
800         int error;
801
802         /*
803          * Get timeout if any.
804          */
805         if (uap->tv != NULL) {
806                 error = copyin(uap->tv, &ktv, sizeof (ktv));
807                 if (error)
808                         return (error);
809                 TIMEVAL_TO_TIMESPEC(&ktv, &kts);
810                 ktsp = &kts;
811         } else {
812                 ktsp = NULL;
813         }
814
815         /*
816          * Do real work.
817          */
818         error = doselect(uap->nd, uap->in, uap->ou, uap->ex, ktsp,
819                          &uap->sysmsg_result);
820
821         return (error);
822 }
823
824
825 /*
826  * Pselect system call.
827  *
828  * MPALMOSTSAFE
829  */
830 int
831 sys_pselect(struct pselect_args *uap)
832 {
833         struct thread *td = curthread;
834         struct lwp *lp = td->td_lwp;
835         struct timespec *ktsp, kts;
836         sigset_t sigmask;
837         int error;
838
839         /*
840          * Get timeout if any.
841          */
842         if (uap->ts != NULL) {
843                 error = copyin(uap->ts, &kts, sizeof (kts));
844                 if (error)
845                         return (error);
846                 ktsp = &kts;
847         } else {
848                 ktsp = NULL;
849         }
850
851         /*
852          * Install temporary signal mask if any provided.
853          */
854         if (uap->sigmask != NULL) {
855                 error = copyin(uap->sigmask, &sigmask, sizeof(sigmask));
856                 if (error)
857                         return (error);
858                 get_mplock();
859                 lp->lwp_oldsigmask = lp->lwp_sigmask;
860                 SIG_CANTMASK(sigmask);
861                 lp->lwp_sigmask = sigmask;
862         } else {
863                 get_mplock();
864         }
865
866         /*
867          * Do real job.
868          */
869         error = doselect(uap->nd, uap->in, uap->ou, uap->ex, ktsp,
870                          &uap->sysmsg_result);
871
872         if (uap->sigmask != NULL) {
873                 /* doselect() responsible for turning ERESTART into EINTR */
874                 KKASSERT(error != ERESTART);
875                 if (error == EINTR) {
876                         /*
877                          * We can't restore the previous signal mask now
878                          * because it could block the signal that interrupted
879                          * us.  So make a note to restore it after executing
880                          * the handler.
881                          */
882                         lp->lwp_flag |= LWP_OLDMASK;
883                 } else {
884                         /*
885                          * No handler to run. Restore previous mask immediately.
886                          */
887                         lp->lwp_sigmask = lp->lwp_oldsigmask;
888                 }
889         }
890         rel_mplock();
891
892         return (error);
893 }
894
895 static int
896 select_copyin(void *arg, struct kevent *kevp, int maxevents, int *events)
897 {
898         struct select_kevent_copyin_args *skap = NULL;
899         struct kevent *kev;
900         int fd;
901         kfd_set *fdp = NULL;
902         short filter = 0;
903         u_int fflags = 0;
904
905         skap = (struct select_kevent_copyin_args *)arg;
906
907         if (*events == maxevents)
908                 return (0);
909
910         while (skap->active_set < COPYIN_DONE) {
911                 switch (skap->active_set) {
912                 case COPYIN_READ:
913                         /*
914                          * Register descriptors for the read filter
915                          */
916                         fdp = skap->read_set;
917                         filter = EVFILT_READ;
918                         fflags = 0;
919                         if (fdp)
920                                 break;
921                         ++skap->active_set;
922                         skap->proc_fds = 0;
923                         /* fall through */
924                 case COPYIN_WRITE:
925                         /*
926                          * Register descriptors for the write filter
927                          */
928                         fdp = skap->write_set;
929                         filter = EVFILT_WRITE;
930                         fflags = 0;
931                         if (fdp)
932                                 break;
933                         ++skap->active_set;
934                         skap->proc_fds = 0;
935                         /* fall through */
936                 case COPYIN_EXCEPT:
937                         /*
938                          * Register descriptors for the exception filter
939                          */
940                         fdp = skap->except_set;
941                         filter = EVFILT_EXCEPT;
942                         fflags = NOTE_OOB;
943                         if (fdp)
944                                 break;
945                         ++skap->active_set;
946                         skap->proc_fds = 0;
947                         /* fall through */
948                 case COPYIN_DONE:
949                         /*
950                          * Nothing left to register
951                          */
952                         return(0);
953                         /* NOT REACHED */
954                 }
955
956                 while (skap->proc_fds < skap->num_fds) {
957                         fd = skap->proc_fds;
958                         if (FD_ISSET(fd, fdp)) {
959                                 kev = &kevp[*events];
960                                 EV_SET(kev, fd, filter,
961                                        EV_ADD|EV_ENABLE,
962                                        fflags, 0,
963                                        (void *)(uintptr_t)
964                                         skap->lwp->lwp_kqueue_serial);
965                                 FD_CLR(fd, fdp);
966                                 ++*events;
967                         }
968                         ++skap->proc_fds;
969                         if (*events == maxevents)
970                                 return (0);
971                 }
972                 skap->active_set++;
973                 skap->proc_fds = 0;
974         }
975
976         return (0);
977 }
978
979 static int
980 select_copyout(void *arg, struct kevent *kevp, int count, int *res)
981 {
982         struct select_kevent_copyin_args *skap;
983         struct kevent kev;
984         int i = 0;
985
986         skap = (struct select_kevent_copyin_args *)arg;
987
988         if (kevp[0].flags & EV_ERROR) {
989                 skap->error = kevp[0].data;
990                 return (0);
991         }
992
993         for (i = 0; i < count; ++i) {
994                 if ((u_int)(uintptr_t)kevp[i].udata !=
995                     skap->lwp->lwp_kqueue_serial) {
996                         kev = kevp[i];
997                         kev.flags = EV_DISABLE|EV_DELETE;
998                         kqueue_register(&skap->lwp->lwp_kqueue, &kev);
999                         continue;
1000                 }
1001
1002                 switch (kevp[i].filter) {
1003                 case EVFILT_READ:
1004                         FD_SET(kevp[i].ident, skap->read_set);
1005                         break;
1006                 case EVFILT_WRITE:
1007                         FD_SET(kevp[i].ident, skap->write_set);
1008                         break;
1009                 case EVFILT_EXCEPT:
1010                         FD_SET(kevp[i].ident, skap->except_set);
1011                         break;
1012                 }
1013
1014                 ++*res;
1015         }
1016
1017         return (0);
1018 }
1019
1020 /*
1021  * Copy select bits in from userland.  Allocate kernel memory if the
1022  * set is large.
1023  */
1024 static int
1025 getbits(int bytes, fd_set *in_set, kfd_set **out_set, kfd_set *tmp_set)
1026 {
1027         int error;
1028
1029         if (in_set) {
1030                 if (bytes < sizeof(*tmp_set))
1031                         *out_set = tmp_set;
1032                 else
1033                         *out_set = kmalloc(bytes, M_SELECT, M_WAITOK);
1034                 error = copyin(in_set, *out_set, bytes);
1035         } else {
1036                 *out_set = NULL;
1037                 error = 0;
1038         }
1039         return (error);
1040 }
1041
1042 /*
1043  * Copy returned select bits back out to userland.
1044  */
1045 static int
1046 putbits(int bytes, kfd_set *in_set, fd_set *out_set)
1047 {
1048         int error;
1049
1050         if (in_set) {
1051                 error = copyout(in_set, out_set, bytes);
1052         } else {
1053                 error = 0;
1054         }
1055         return (error);
1056 }
1057
1058 /*
1059  * Common code for sys_select() and sys_pselect().
1060  *
1061  * in, out and ex are userland pointers.  ts must point to validated
1062  * kernel-side timeout value or NULL for infinite timeout.  res must
1063  * point to syscall return value.
1064  */
1065 static int
1066 doselect(int nd, fd_set *read, fd_set *write, fd_set *except,
1067          struct timespec *ts, int *res)
1068 {
1069         struct proc *p = curproc;
1070         struct select_kevent_copyin_args *kap, ka;
1071         int bytes, error;
1072         kfd_set read_tmp;
1073         kfd_set write_tmp;
1074         kfd_set except_tmp;
1075
1076         *res = 0;
1077         if (nd < 0)
1078                 return (EINVAL);
1079         if (nd > p->p_fd->fd_nfiles)            /* limit kmalloc */
1080                 nd = p->p_fd->fd_nfiles;
1081
1082         kap = &ka;
1083         kap->lwp = curthread->td_lwp;
1084         kap->num_fds = nd;
1085         kap->proc_fds = 0;
1086         kap->error = 0;
1087         kap->active_set = COPYIN_READ;
1088
1089         /*
1090          * Calculate bytes based on the number of __fd_mask[] array entries
1091          * multiplied by the size of __fd_mask.
1092          */
1093         bytes = howmany(nd, __NFDBITS) * sizeof(__fd_mask);
1094
1095         error = getbits(bytes, read, &kap->read_set, &read_tmp);
1096         if (error == 0)
1097                 error = getbits(bytes, write, &kap->write_set, &write_tmp);
1098         if (error == 0)
1099                 error = getbits(bytes, except, &kap->except_set, &except_tmp);
1100         if (error)
1101                 goto done;
1102
1103         /*
1104          * NOTE: Make sure the max events passed to kern_kevent() is
1105          *       effectively unlimited.  (nd * 3) accomplishes this.
1106          *
1107          *       (*res) continues to increment as returned events are
1108          *       loaded in.
1109          */
1110         error = kern_kevent(&kap->lwp->lwp_kqueue, 0x7FFFFFFF, res, kap,
1111                             select_copyin, select_copyout, ts);
1112         if (error == 0)
1113                 error = putbits(bytes, kap->read_set, read);
1114         if (error == 0)
1115                 error = putbits(bytes, kap->write_set, write);
1116         if (error == 0)
1117                 error = putbits(bytes, kap->except_set, except);
1118
1119         /*
1120          * Cumulative error from individual events (EBADFD?)
1121          */
1122         if (kap->error)
1123                 error = kap->error;
1124
1125         /*
1126          * Clean up.
1127          */
1128 done:
1129         if (kap->read_set && kap->read_set != &read_tmp)
1130                 kfree(kap->read_set, M_SELECT);
1131         if (kap->write_set && kap->write_set != &write_tmp)
1132                 kfree(kap->write_set, M_SELECT);
1133         if (kap->except_set && kap->except_set != &except_tmp)
1134                 kfree(kap->except_set, M_SELECT);
1135
1136         kap->lwp->lwp_kqueue_serial++;
1137
1138         return (error);
1139 }
1140
1141 /*
1142  * Poll system call.
1143  *
1144  * MPSAFE
1145  */
1146 int
1147 sys_poll(struct poll_args *uap)
1148 {
1149         struct timespec ts, *tsp;
1150         int error;
1151
1152         if (uap->timeout != INFTIM) {
1153                 ts.tv_sec = uap->timeout / 1000;
1154                 ts.tv_nsec = (uap->timeout % 1000) * 1000 * 1000;
1155                 tsp = &ts;
1156         } else {
1157                 tsp = NULL;
1158         }
1159
1160         error = dopoll(uap->nfds, uap->fds, tsp, &uap->sysmsg_result);
1161
1162         return (error);
1163 }
1164
1165 static int
1166 poll_copyin(void *arg, struct kevent *kevp, int maxevents, int *events)
1167 {
1168         struct poll_kevent_copyin_args *pkap;
1169         struct pollfd *pfd;
1170         struct kevent *kev;
1171         int kev_count;
1172
1173         pkap = (struct poll_kevent_copyin_args *)arg;
1174
1175         while (pkap->pfds < pkap->nfds) {
1176                 pfd = &pkap->fds[pkap->pfds];
1177
1178                 /* Clear return events */
1179                 pfd->revents = 0;
1180
1181                 /* Do not check if fd is equal to -1 */
1182                 if (pfd->fd == -1) {
1183                         ++pkap->pfds;
1184                         continue;
1185                 }
1186
1187                 kev_count = 0;
1188                 if (pfd->events & (POLLIN | POLLRDNORM))
1189                         kev_count++;
1190                 if (pfd->events & (POLLOUT | POLLWRNORM))
1191                         kev_count++;
1192                 if (pfd->events & (POLLPRI | POLLRDBAND))
1193                         kev_count++;
1194
1195                 if (*events + kev_count > maxevents)
1196                         return (0);
1197
1198                 /*
1199                  * NOTE: A combined serial number and poll array index is
1200                  * stored in kev->udata.
1201                  */
1202                 kev = &kevp[*events];
1203                 if (pfd->events & (POLLIN | POLLRDNORM)) {
1204                         EV_SET(kev++, pfd->fd, EVFILT_READ, EV_ADD|EV_ENABLE,
1205                                0, 0, (void *)(uintptr_t)
1206                                 (pkap->lwp->lwp_kqueue_serial + pkap->pfds));
1207                 }
1208                 if (pfd->events & (POLLOUT | POLLWRNORM)) {
1209                         EV_SET(kev++, pfd->fd, EVFILT_WRITE, EV_ADD|EV_ENABLE,
1210                                0, 0, (void *)(uintptr_t)
1211                                 (pkap->lwp->lwp_kqueue_serial + pkap->pfds));
1212                 }
1213                 if (pfd->events & (POLLPRI | POLLRDBAND)) {
1214                         EV_SET(kev++, pfd->fd, EVFILT_EXCEPT, EV_ADD|EV_ENABLE,
1215                                NOTE_OOB, 0,
1216                                (void *)(uintptr_t)
1217                                 (pkap->lwp->lwp_kqueue_serial + pkap->pfds));
1218                 }
1219
1220                 if (nseldebug) {
1221                         kprintf("poll index %d/%d fd %d events %08x serial %d\n",
1222                                 pkap->pfds, pkap->nfds-1, pfd->fd, pfd->events,
1223                                 pkap->lwp->lwp_kqueue_serial);
1224                 }
1225
1226                 ++pkap->pfds;
1227                 (*events) += kev_count;
1228         }
1229
1230         return (0);
1231 }
1232
1233 static int
1234 poll_copyout(void *arg, struct kevent *kevp, int count, int *res)
1235 {
1236         struct poll_kevent_copyin_args *pkap;
1237         struct pollfd *pfd;
1238         struct kevent kev;
1239         int i;
1240         u_int pi;
1241
1242         pkap = (struct poll_kevent_copyin_args *)arg;
1243
1244         for (i = 0; i < count; ++i) {
1245                 /*
1246                  * Extract the poll array index and delete spurious events.
1247                  * We can easily tell if the serial number is incorrect
1248                  * by checking whether the extracted index is out of range.
1249                  */
1250                 pi = (u_int)(uintptr_t)kevp[i].udata -
1251                      (u_int)pkap->lwp->lwp_kqueue_serial;
1252
1253                 if (pi >= pkap->nfds) {
1254                         kev = kevp[i];
1255                         kev.flags = EV_DISABLE|EV_DELETE;
1256                         kqueue_register(&pkap->lwp->lwp_kqueue, &kev);
1257                         if (nseldebug)
1258                                 kprintf("poll index %d out of range against serial %d\n",
1259                                         pi, pkap->lwp->lwp_kqueue_serial);
1260                         continue;
1261                 }
1262                 pfd = &pkap->fds[pi];
1263                 if (kevp[i].ident == pfd->fd) {
1264                         /*
1265                          * A single descriptor may generate an error against
1266                          * more than one filter, make sure to set the appropriate
1267                          * flags but do not increment (*res) more than once.
1268                          */
1269                         if (kevp[i].flags & EV_ERROR) {
1270                                 switch(kevp[i].data) {
1271                                 case EOPNOTSUPP:
1272                                         /*
1273                                          * Operation not supported.  Poll
1274                                          * does not return an error for
1275                                          * POLLPRI (OOB/urgent data) when
1276                                          * it is not supported by the device.
1277                                          */
1278                                         if (kevp[i].filter != EVFILT_EXCEPT) {
1279                                                 if (pfd->revents == 0)
1280                                                         ++*res;
1281                                                 pfd->revents |= POLLERR;
1282                                         }
1283                                         break;
1284                                 case EBADF:
1285                                         /* Bad file descriptor */
1286                                         if (pfd->revents == 0)
1287                                                 ++*res;
1288                                         pfd->revents |= POLLNVAL;
1289                                         break;
1290                                 default:
1291                                         if (pfd->revents == 0)
1292                                                 ++*res;
1293                                         pfd->revents |= POLLERR;
1294                                         break;
1295                                 }
1296                                 if (nseldebug) {
1297                                         kprintf("poll index %d fd %d "
1298                                                 "filter %d error %d\n",
1299                                                 pi, pfd->fd,
1300                                                 kevp[i].filter,
1301                                                 (u_int)kevp[i].data);
1302                                 }
1303                                 continue;
1304                         }
1305
1306                         if (kevp[i].flags & EV_EOF) {
1307                                 if (pfd->revents == 0)
1308                                         ++*res;
1309                                 pfd->revents |= POLLHUP;
1310                                 continue;
1311                         }
1312
1313                         switch (kevp[i].filter) {
1314                         case EVFILT_READ:
1315                                 pfd->revents |= (POLLIN | POLLRDNORM);
1316                                 break;
1317                         case EVFILT_WRITE:
1318                                 pfd->revents |= (POLLOUT | POLLWRNORM);
1319                                 break;
1320                         case EVFILT_EXCEPT:
1321                                 pfd->revents |= (POLLPRI | POLLRDBAND);
1322                                 break;
1323                         }
1324
1325                         if (nseldebug) {
1326                                 kprintf("poll index %d/%d fd %d revents %08x\n",
1327                                         pi, pkap->nfds, pfd->fd, pfd->revents);
1328                         }
1329
1330                         ++*res;
1331                         continue;
1332                 } else {
1333                         if (nseldebug) {
1334                                 kprintf("poll index %d mismatch %d/%d\n",
1335                                         pi, (u_int)kevp[i].ident, pfd->fd);
1336                         }
1337                 }
1338         }
1339
1340         return (0);
1341 }
1342
1343 static int
1344 dopoll(int nfds, struct pollfd *fds, struct timespec *ts, int *res)
1345 {
1346         struct poll_kevent_copyin_args ka;
1347         struct pollfd sfds[64];
1348         int bytes;
1349         int error;
1350
1351         *res = 0;
1352         if (nfds < 0)
1353                 return (EINVAL);
1354
1355         /*
1356          * This is a bit arbitrary but we need to limit internal kmallocs.
1357          */
1358         if (nfds > maxfilesperproc * 2)
1359                 nfds = maxfilesperproc * 2;
1360         bytes = sizeof(struct pollfd) * nfds;
1361
1362         ka.lwp = curthread->td_lwp;
1363         ka.nfds = nfds;
1364         ka.pfds = 0;
1365         ka.error = 0;
1366
1367         if (ka.nfds < 64)
1368                 ka.fds = sfds;
1369         else
1370                 ka.fds = kmalloc(bytes, M_SELECT, M_WAITOK);
1371
1372         error = copyin(fds, ka.fds, bytes);
1373         if (error == 0)
1374                 error = kern_kevent(&ka.lwp->lwp_kqueue, 0x7FFFFFFF, res, &ka,
1375                                     poll_copyin, poll_copyout, ts);
1376
1377         if (error == 0)
1378                 error = copyout(ka.fds, fds, bytes);
1379
1380         if (ka.fds != sfds)
1381                 kfree(ka.fds, M_SELECT);
1382
1383         ka.lwp->lwp_kqueue_serial += nfds;
1384
1385         return (error);
1386 }
1387
1388 static int
1389 socket_wait_copyin(void *arg, struct kevent *kevp, int maxevents, int *events)
1390 {
1391         return (0);
1392 }
1393
1394 static int
1395 socket_wait_copyout(void *arg, struct kevent *kevp, int count, int *res)
1396 {
1397         ++*res;
1398         return (0);
1399 }
1400
1401 extern  struct fileops socketops;
1402 int
1403 socket_wait(struct socket *so, struct timespec *ts, int *res)
1404 {
1405         struct thread *td = curthread;
1406         struct file *fp;
1407         struct kqueue kq;
1408         struct kevent kev;
1409         int error, fd;
1410
1411         if ((error = falloc(td->td_lwp, &fp, &fd)) != 0)
1412                 return (error);
1413
1414         fp->f_type = DTYPE_SOCKET;
1415         fp->f_flag = FREAD | FWRITE;
1416         fp->f_ops = &socketops;
1417         fp->f_data = so;
1418         fsetfd(td->td_lwp->lwp_proc->p_fd, fp, fd);
1419
1420         kqueue_init(&kq, td->td_lwp->lwp_proc->p_fd);
1421         EV_SET(&kev, fd, EVFILT_READ, EV_ADD|EV_ENABLE, 0, 0, NULL);
1422         if ((error = kqueue_register(&kq, &kev)) != 0) {
1423                 fdrop(fp);
1424                 return (error);
1425         }
1426
1427         error = kern_kevent(&kq, 1, res, NULL, socket_wait_copyin,
1428                             socket_wait_copyout, ts);
1429
1430         EV_SET(&kev, fd, EVFILT_READ, EV_DELETE, 0, 0, NULL);
1431         kqueue_register(&kq, &kev);
1432         fp->f_ops = &badfileops;
1433         fdrop(fp);
1434
1435         return (error);
1436 }
1437
1438 /*
1439  * OpenBSD poll system call.
1440  * XXX this isn't quite a true representation..  OpenBSD uses select ops.
1441  *
1442  * MPSAFE
1443  */
1444 int
1445 sys_openbsd_poll(struct openbsd_poll_args *uap)
1446 {
1447         return (sys_poll((struct poll_args *)uap));
1448 }
1449
1450 /*ARGSUSED*/
1451 int
1452 seltrue(cdev_t dev, int events)
1453 {
1454         return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM));
1455 }