source: rtems-libbsd/freebsd/sys/kern/sys_generic.c @ facf9dc

4.115-freebsd-12freebsd-9.3
Last change on this file since facf9dc was facf9dc, checked in by Sebastian Huber <sebastian.huber@…>, on Oct 23, 2013 at 2:10:26 PM

Use select() from FreeBSD

  • Property mode set to 100644
File size: 36.1 KB
Line 
1#include <machine/rtems-bsd-config.h>
2
3/*-
4 * Copyright (c) 1982, 1986, 1989, 1993
5 *      The Regents of the University of California.  All rights reserved.
6 * (c) UNIX System Laboratories, Inc.
7 * All or some portions of this file are derived from material licensed
8 * to the University of California by American Telephone and Telegraph
9 * Co. or Unix System Laboratories, Inc. and are reproduced herein with
10 * the permission of UNIX System Laboratories, Inc.
11 *
12 * Redistribution and use in source and binary forms, with or without
13 * modification, are permitted provided that the following conditions
14 * are met:
15 * 1. Redistributions of source code must retain the above copyright
16 *    notice, this list of conditions and the following disclaimer.
17 * 2. Redistributions in binary form must reproduce the above copyright
18 *    notice, this list of conditions and the following disclaimer in the
19 *    documentation and/or other materials provided with the distribution.
20 * 4. Neither the name of the University nor the names of its contributors
21 *    may be used to endorse or promote products derived from this software
22 *    without specific prior written permission.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 * SUCH DAMAGE.
35 *
36 *      @(#)sys_generic.c       8.5 (Berkeley) 1/21/94
37 */
38
39#include <sys/cdefs.h>
40__FBSDID("$FreeBSD$");
41
42
43#include <rtems/bsd/local/opt_compat.h>
44#include <rtems/bsd/local/opt_ktrace.h>
45
46#include <rtems/bsd/sys/param.h>
47#include <sys/systm.h>
48#include <sys/sysproto.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/ktr.h>
59#include <sys/limits.h>
60#include <sys/malloc.h>
61#include <sys/poll.h>
62#include <sys/resourcevar.h>
63#include <sys/selinfo.h>
64#include <sys/sleepqueue.h>
65#include <sys/syscallsubr.h>
66#include <sys/sysctl.h>
67#include <sys/sysent.h>
68#include <sys/vnode.h>
69#include <sys/bio.h>
70#include <sys/buf.h>
71#include <sys/condvar.h>
72#ifdef KTRACE
73#include <sys/ktrace.h>
74#endif
75
76#include <security/audit/audit.h>
77#ifdef __rtems__
78#include <machine/rtems-bsd-syscall-api.h>
79#endif /* __rtems__ */
80
81#ifndef __rtems__
82static MALLOC_DEFINE(M_IOCTLOPS, "ioctlops", "ioctl data buffer");
83#endif /* __rtems__ */
84static MALLOC_DEFINE(M_SELECT, "select", "select() buffer");
85#ifndef __rtems__
86MALLOC_DEFINE(M_IOV, "iov", "large iov's");
87#endif /* __rtems__ */
88
89#ifndef __rtems__
90static int      pollout(struct thread *, struct pollfd *, struct pollfd *,
91                    u_int);
92static int      pollscan(struct thread *, struct pollfd *, u_int);
93static int      pollrescan(struct thread *);
94#endif /* __rtems__ */
95static int      selscan(struct thread *, fd_mask **, fd_mask **, int);
96static int      selrescan(struct thread *, fd_mask **, fd_mask **);
97static void     selfdalloc(struct thread *, void *);
98static void     selfdfree(struct seltd *, struct selfd *);
99#ifndef __rtems__
100static int      dofileread(struct thread *, int, struct file *, struct uio *,
101                    off_t, int);
102static int      dofilewrite(struct thread *, int, struct file *, struct uio *,
103                    off_t, int);
104#endif /* __rtems__ */
105static void     doselwakeup(struct selinfo *, int);
106static void     seltdinit(struct thread *);
107static int      seltdwait(struct thread *, int);
108static void     seltdclear(struct thread *);
109
110/*
111 * One seltd per-thread allocated on demand as needed.
112 *
113 *      t - protected by st_mtx
114 *      k - Only accessed by curthread or read-only
115 */
116struct seltd {
117        STAILQ_HEAD(, selfd)    st_selq;        /* (k) List of selfds. */
118        struct selfd            *st_free1;      /* (k) free fd for read set. */
119        struct selfd            *st_free2;      /* (k) free fd for write set. */
120        struct mtx              st_mtx;         /* Protects struct seltd */
121        struct cv               st_wait;        /* (t) Wait channel. */
122        int                     st_flags;       /* (t) SELTD_ flags. */
123};
124
125#define SELTD_PENDING   0x0001                  /* We have pending events. */
126#define SELTD_RESCAN    0x0002                  /* Doing a rescan. */
127
128/*
129 * One selfd allocated per-thread per-file-descriptor.
130 *      f - protected by sf_mtx
131 */
132struct selfd {
133        STAILQ_ENTRY(selfd)     sf_link;        /* (k) fds owned by this td. */
134        TAILQ_ENTRY(selfd)      sf_threads;     /* (f) fds on this selinfo. */
135        struct selinfo          *sf_si;         /* (f) selinfo when linked. */
136        struct mtx              *sf_mtx;        /* Pointer to selinfo mtx. */
137        struct seltd            *sf_td;         /* (k) owning seltd. */
138        void                    *sf_cookie;     /* (k) fd or pollfd. */
139};
140
141static uma_zone_t selfd_zone;
142static struct mtx_pool *mtxpool_select;
143
144#ifndef __rtems__
145#ifndef _SYS_SYSPROTO_H_
146struct read_args {
147        int     fd;
148        void    *buf;
149        size_t  nbyte;
150};
151#endif
152int
153read(td, uap)
154        struct thread *td;
155        struct read_args *uap;
156{
157        struct uio auio;
158        struct iovec aiov;
159        int error;
160
161        if (uap->nbyte > INT_MAX)
162                return (EINVAL);
163        aiov.iov_base = uap->buf;
164        aiov.iov_len = uap->nbyte;
165        auio.uio_iov = &aiov;
166        auio.uio_iovcnt = 1;
167        auio.uio_resid = uap->nbyte;
168        auio.uio_segflg = UIO_USERSPACE;
169        error = kern_readv(td, uap->fd, &auio);
170        return(error);
171}
172
173/*
174 * Positioned read system call
175 */
176#ifndef _SYS_SYSPROTO_H_
177struct pread_args {
178        int     fd;
179        void    *buf;
180        size_t  nbyte;
181        int     pad;
182        off_t   offset;
183};
184#endif
185int
186pread(td, uap)
187        struct thread *td;
188        struct pread_args *uap;
189{
190        struct uio auio;
191        struct iovec aiov;
192        int error;
193
194        if (uap->nbyte > INT_MAX)
195                return (EINVAL);
196        aiov.iov_base = uap->buf;
197        aiov.iov_len = uap->nbyte;
198        auio.uio_iov = &aiov;
199        auio.uio_iovcnt = 1;
200        auio.uio_resid = uap->nbyte;
201        auio.uio_segflg = UIO_USERSPACE;
202        error = kern_preadv(td, uap->fd, &auio, uap->offset);
203        return(error);
204}
205
206int
207freebsd6_pread(td, uap)
208        struct thread *td;
209        struct freebsd6_pread_args *uap;
210{
211        struct pread_args oargs;
212
213        oargs.fd = uap->fd;
214        oargs.buf = uap->buf;
215        oargs.nbyte = uap->nbyte;
216        oargs.offset = uap->offset;
217        return (pread(td, &oargs));
218}
219
220/*
221 * Scatter read system call.
222 */
223#ifndef _SYS_SYSPROTO_H_
224struct readv_args {
225        int     fd;
226        struct  iovec *iovp;
227        u_int   iovcnt;
228};
229#endif
230int
231readv(struct thread *td, struct readv_args *uap)
232{
233        struct uio *auio;
234        int error;
235
236        error = copyinuio(uap->iovp, uap->iovcnt, &auio);
237        if (error)
238                return (error);
239        error = kern_readv(td, uap->fd, auio);
240        free(auio, M_IOV);
241        return (error);
242}
243
244int
245kern_readv(struct thread *td, int fd, struct uio *auio)
246{
247        struct file *fp;
248        int error;
249
250        error = fget_read(td, fd, &fp);
251        if (error)
252                return (error);
253        error = dofileread(td, fd, fp, auio, (off_t)-1, 0);
254        fdrop(fp, td);
255        return (error);
256}
257
258/*
259 * Scatter positioned read system call.
260 */
261#ifndef _SYS_SYSPROTO_H_
262struct preadv_args {
263        int     fd;
264        struct  iovec *iovp;
265        u_int   iovcnt;
266        off_t   offset;
267};
268#endif
269int
270preadv(struct thread *td, struct preadv_args *uap)
271{
272        struct uio *auio;
273        int error;
274
275        error = copyinuio(uap->iovp, uap->iovcnt, &auio);
276        if (error)
277                return (error);
278        error = kern_preadv(td, uap->fd, auio, uap->offset);
279        free(auio, M_IOV);
280        return (error);
281}
282
283int
284kern_preadv(td, fd, auio, offset)
285        struct thread *td;
286        int fd;
287        struct uio *auio;
288        off_t offset;
289{
290        struct file *fp;
291        int error;
292
293        error = fget_read(td, fd, &fp);
294        if (error)
295                return (error);
296        if (!(fp->f_ops->fo_flags & DFLAG_SEEKABLE))
297                error = ESPIPE;
298        else if (offset < 0 && fp->f_vnode->v_type != VCHR)
299                error = EINVAL;
300        else
301                error = dofileread(td, fd, fp, auio, offset, FOF_OFFSET);
302        fdrop(fp, td);
303        return (error);
304}
305
306/*
307 * Common code for readv and preadv that reads data in
308 * from a file using the passed in uio, offset, and flags.
309 */
310static int
311dofileread(td, fd, fp, auio, offset, flags)
312        struct thread *td;
313        int fd;
314        struct file *fp;
315        struct uio *auio;
316        off_t offset;
317        int flags;
318{
319        ssize_t cnt;
320        int error;
321#ifdef KTRACE
322        struct uio *ktruio = NULL;
323#endif
324
325        /* Finish zero length reads right here */
326        if (auio->uio_resid == 0) {
327                td->td_retval[0] = 0;
328                return(0);
329        }
330        auio->uio_rw = UIO_READ;
331        auio->uio_offset = offset;
332        auio->uio_td = td;
333#ifdef KTRACE
334        if (KTRPOINT(td, KTR_GENIO)) 
335                ktruio = cloneuio(auio);
336#endif
337        cnt = auio->uio_resid;
338        if ((error = fo_read(fp, auio, td->td_ucred, flags, td))) {
339                if (auio->uio_resid != cnt && (error == ERESTART ||
340                    error == EINTR || error == EWOULDBLOCK))
341                        error = 0;
342        }
343        cnt -= auio->uio_resid;
344#ifdef KTRACE
345        if (ktruio != NULL) {
346                ktruio->uio_resid = cnt;
347                ktrgenio(fd, UIO_READ, ktruio, error);
348        }
349#endif
350        td->td_retval[0] = cnt;
351        return (error);
352}
353
354#ifndef _SYS_SYSPROTO_H_
355struct write_args {
356        int     fd;
357        const void *buf;
358        size_t  nbyte;
359};
360#endif
361int
362write(td, uap)
363        struct thread *td;
364        struct write_args *uap;
365{
366        struct uio auio;
367        struct iovec aiov;
368        int error;
369
370        if (uap->nbyte > INT_MAX)
371                return (EINVAL);
372        aiov.iov_base = (void *)(uintptr_t)uap->buf;
373        aiov.iov_len = uap->nbyte;
374        auio.uio_iov = &aiov;
375        auio.uio_iovcnt = 1;
376        auio.uio_resid = uap->nbyte;
377        auio.uio_segflg = UIO_USERSPACE;
378        error = kern_writev(td, uap->fd, &auio);
379        return(error);
380}
381
382/*
383 * Positioned write system call.
384 */
385#ifndef _SYS_SYSPROTO_H_
386struct pwrite_args {
387        int     fd;
388        const void *buf;
389        size_t  nbyte;
390        int     pad;
391        off_t   offset;
392};
393#endif
394int
395pwrite(td, uap)
396        struct thread *td;
397        struct pwrite_args *uap;
398{
399        struct uio auio;
400        struct iovec aiov;
401        int error;
402
403        if (uap->nbyte > INT_MAX)
404                return (EINVAL);
405        aiov.iov_base = (void *)(uintptr_t)uap->buf;
406        aiov.iov_len = uap->nbyte;
407        auio.uio_iov = &aiov;
408        auio.uio_iovcnt = 1;
409        auio.uio_resid = uap->nbyte;
410        auio.uio_segflg = UIO_USERSPACE;
411        error = kern_pwritev(td, uap->fd, &auio, uap->offset);
412        return(error);
413}
414
415int
416freebsd6_pwrite(td, uap)
417        struct thread *td;
418        struct freebsd6_pwrite_args *uap;
419{
420        struct pwrite_args oargs;
421
422        oargs.fd = uap->fd;
423        oargs.buf = uap->buf;
424        oargs.nbyte = uap->nbyte;
425        oargs.offset = uap->offset;
426        return (pwrite(td, &oargs));
427}
428
429/*
430 * Gather write system call.
431 */
432#ifndef _SYS_SYSPROTO_H_
433struct writev_args {
434        int     fd;
435        struct  iovec *iovp;
436        u_int   iovcnt;
437};
438#endif
439int
440writev(struct thread *td, struct writev_args *uap)
441{
442        struct uio *auio;
443        int error;
444
445        error = copyinuio(uap->iovp, uap->iovcnt, &auio);
446        if (error)
447                return (error);
448        error = kern_writev(td, uap->fd, auio);
449        free(auio, M_IOV);
450        return (error);
451}
452
453int
454kern_writev(struct thread *td, int fd, struct uio *auio)
455{
456        struct file *fp;
457        int error;
458
459        error = fget_write(td, fd, &fp);
460        if (error)
461                return (error);
462        error = dofilewrite(td, fd, fp, auio, (off_t)-1, 0);
463        fdrop(fp, td);
464        return (error);
465}
466
467/*
468 * Gather positioned write system call.
469 */
470#ifndef _SYS_SYSPROTO_H_
471struct pwritev_args {
472        int     fd;
473        struct  iovec *iovp;
474        u_int   iovcnt;
475        off_t   offset;
476};
477#endif
478int
479pwritev(struct thread *td, struct pwritev_args *uap)
480{
481        struct uio *auio;
482        int error;
483
484        error = copyinuio(uap->iovp, uap->iovcnt, &auio);
485        if (error)
486                return (error);
487        error = kern_pwritev(td, uap->fd, auio, uap->offset);
488        free(auio, M_IOV);
489        return (error);
490}
491
492int
493kern_pwritev(td, fd, auio, offset)
494        struct thread *td;
495        struct uio *auio;
496        int fd;
497        off_t offset;
498{
499        struct file *fp;
500        int error;
501
502        error = fget_write(td, fd, &fp);
503        if (error)
504                return (error);
505        if (!(fp->f_ops->fo_flags & DFLAG_SEEKABLE))
506                error = ESPIPE;
507        else if (offset < 0 && fp->f_vnode->v_type != VCHR)
508                error = EINVAL;
509        else
510                error = dofilewrite(td, fd, fp, auio, offset, FOF_OFFSET);
511        fdrop(fp, td);
512        return (error);
513}
514
515/*
516 * Common code for writev and pwritev that writes data to
517 * a file using the passed in uio, offset, and flags.
518 */
519static int
520dofilewrite(td, fd, fp, auio, offset, flags)
521        struct thread *td;
522        int fd;
523        struct file *fp;
524        struct uio *auio;
525        off_t offset;
526        int flags;
527{
528        ssize_t cnt;
529        int error;
530#ifdef KTRACE
531        struct uio *ktruio = NULL;
532#endif
533
534        auio->uio_rw = UIO_WRITE;
535        auio->uio_td = td;
536        auio->uio_offset = offset;
537#ifdef KTRACE
538        if (KTRPOINT(td, KTR_GENIO))
539                ktruio = cloneuio(auio);
540#endif
541        cnt = auio->uio_resid;
542        if (fp->f_type == DTYPE_VNODE)
543                bwillwrite();
544        if ((error = fo_write(fp, auio, td->td_ucred, flags, td))) {
545                if (auio->uio_resid != cnt && (error == ERESTART ||
546                    error == EINTR || error == EWOULDBLOCK))
547                        error = 0;
548                /* Socket layer is responsible for issuing SIGPIPE. */
549                if (fp->f_type != DTYPE_SOCKET && error == EPIPE) {
550                        PROC_LOCK(td->td_proc);
551                        tdksignal(td, SIGPIPE, NULL);
552                        PROC_UNLOCK(td->td_proc);
553                }
554        }
555        cnt -= auio->uio_resid;
556#ifdef KTRACE
557        if (ktruio != NULL) {
558                ktruio->uio_resid = cnt;
559                ktrgenio(fd, UIO_WRITE, ktruio, error);
560        }
561#endif
562        td->td_retval[0] = cnt;
563        return (error);
564}
565
566/*
567 * Truncate a file given a file descriptor.
568 *
569 * Can't use fget_write() here, since must return EINVAL and not EBADF if the
570 * descriptor isn't writable.
571 */
572int
573kern_ftruncate(td, fd, length)
574        struct thread *td;
575        int fd;
576        off_t length;
577{
578        struct file *fp;
579        int error;
580
581        AUDIT_ARG_FD(fd);
582        if (length < 0)
583                return (EINVAL);
584        error = fget(td, fd, &fp);
585        if (error)
586                return (error);
587        AUDIT_ARG_FILE(td->td_proc, fp);
588        if (!(fp->f_flag & FWRITE)) {
589                fdrop(fp, td);
590                return (EINVAL);
591        }
592        error = fo_truncate(fp, length, td->td_ucred, td);
593        fdrop(fp, td);
594        return (error);
595}
596
597#ifndef _SYS_SYSPROTO_H_
598struct ftruncate_args {
599        int     fd;
600        int     pad;
601        off_t   length;
602};
603#endif
604int
605ftruncate(td, uap)
606        struct thread *td;
607        struct ftruncate_args *uap;
608{
609
610        return (kern_ftruncate(td, uap->fd, uap->length));
611}
612
613#if defined(COMPAT_43)
614#ifndef _SYS_SYSPROTO_H_
615struct oftruncate_args {
616        int     fd;
617        long    length;
618};
619#endif
620int
621oftruncate(td, uap)
622        struct thread *td;
623        struct oftruncate_args *uap;
624{
625
626        return (kern_ftruncate(td, uap->fd, uap->length));
627}
628#endif /* COMPAT_43 */
629
630#ifndef _SYS_SYSPROTO_H_
631struct ioctl_args {
632        int     fd;
633        u_long  com;
634        caddr_t data;
635};
636#endif
637/* ARGSUSED */
638int
639ioctl(struct thread *td, struct ioctl_args *uap)
640{
641        u_long com;
642        int arg, error;
643        u_int size;
644        caddr_t data;
645
646        if (uap->com > 0xffffffff) {
647                printf(
648                    "WARNING pid %d (%s): ioctl sign-extension ioctl %lx\n",
649                    td->td_proc->p_pid, td->td_name, uap->com);
650                uap->com &= 0xffffffff;
651        }
652        com = uap->com;
653
654        /*
655         * Interpret high order word to find amount of data to be
656         * copied to/from the user's address space.
657         */
658        size = IOCPARM_LEN(com);
659        if ((size > IOCPARM_MAX) ||
660            ((com & (IOC_VOID  | IOC_IN | IOC_OUT)) == 0) ||
661#if defined(COMPAT_FREEBSD5) || defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
662            ((com & IOC_OUT) && size == 0) ||
663#else
664            ((com & (IOC_IN | IOC_OUT)) && size == 0) ||
665#endif
666            ((com & IOC_VOID) && size > 0 && size != sizeof(int)))
667                return (ENOTTY);
668
669        if (size > 0) {
670                if (com & IOC_VOID) {
671                        /* Integer argument. */
672                        arg = (intptr_t)uap->data;
673                        data = (void *)&arg;
674                        size = 0;
675                } else
676                        data = malloc((u_long)size, M_IOCTLOPS, M_WAITOK);
677        } else
678                data = (void *)&uap->data;
679        if (com & IOC_IN) {
680                error = copyin(uap->data, data, (u_int)size);
681                if (error) {
682                        if (size > 0)
683                                free(data, M_IOCTLOPS);
684                        return (error);
685                }
686        } else if (com & IOC_OUT) {
687                /*
688                 * Zero the buffer so the user always
689                 * gets back something deterministic.
690                 */
691                bzero(data, size);
692        }
693
694        error = kern_ioctl(td, uap->fd, com, data);
695
696        if (error == 0 && (com & IOC_OUT))
697                error = copyout(data, uap->data, (u_int)size);
698
699        if (size > 0)
700                free(data, M_IOCTLOPS);
701        return (error);
702}
703
704int
705kern_ioctl(struct thread *td, int fd, u_long com, caddr_t data)
706{
707        struct file *fp;
708        struct filedesc *fdp;
709        int error;
710        int tmp;
711
712        AUDIT_ARG_FD(fd);
713        AUDIT_ARG_CMD(com);
714        if ((error = fget(td, fd, &fp)) != 0)
715                return (error);
716        if ((fp->f_flag & (FREAD | FWRITE)) == 0) {
717                fdrop(fp, td);
718                return (EBADF);
719        }
720        fdp = td->td_proc->p_fd;
721        switch (com) {
722        case FIONCLEX:
723                FILEDESC_XLOCK(fdp);
724                fdp->fd_ofileflags[fd] &= ~UF_EXCLOSE;
725                FILEDESC_XUNLOCK(fdp);
726                goto out;
727        case FIOCLEX:
728                FILEDESC_XLOCK(fdp);
729                fdp->fd_ofileflags[fd] |= UF_EXCLOSE;
730                FILEDESC_XUNLOCK(fdp);
731                goto out;
732        case FIONBIO:
733                if ((tmp = *(int *)data))
734                        atomic_set_int(&fp->f_flag, FNONBLOCK);
735                else
736                        atomic_clear_int(&fp->f_flag, FNONBLOCK);
737                data = (void *)&tmp;
738                break;
739        case FIOASYNC:
740                if ((tmp = *(int *)data))
741                        atomic_set_int(&fp->f_flag, FASYNC);
742                else
743                        atomic_clear_int(&fp->f_flag, FASYNC);
744                data = (void *)&tmp;
745                break;
746        }
747
748        error = fo_ioctl(fp, com, data, td->td_ucred, td);
749out:
750        fdrop(fp, td);
751        return (error);
752}
753
754int
755poll_no_poll(int events)
756{
757        /*
758         * Return true for read/write.  If the user asked for something
759         * special, return POLLNVAL, so that clients have a way of
760         * determining reliably whether or not the extended
761         * functionality is present without hard-coding knowledge
762         * of specific filesystem implementations.
763         */
764        if (events & ~POLLSTANDARD)
765                return (POLLNVAL);
766
767        return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM));
768}
769
770int
771pselect(struct thread *td, struct pselect_args *uap)
772{
773        struct timespec ts;
774        struct timeval tv, *tvp;
775        sigset_t set, *uset;
776        int error;
777
778        if (uap->ts != NULL) {
779                error = copyin(uap->ts, &ts, sizeof(ts));
780                if (error != 0)
781                    return (error);
782                TIMESPEC_TO_TIMEVAL(&tv, &ts);
783                tvp = &tv;
784        } else
785                tvp = NULL;
786        if (uap->sm != NULL) {
787                error = copyin(uap->sm, &set, sizeof(set));
788                if (error != 0)
789                        return (error);
790                uset = &set;
791        } else
792                uset = NULL;
793        return (kern_pselect(td, uap->nd, uap->in, uap->ou, uap->ex, tvp,
794            uset, NFDBITS));
795}
796
797int
798kern_pselect(struct thread *td, int nd, fd_set *in, fd_set *ou, fd_set *ex,
799    struct timeval *tvp, sigset_t *uset, int abi_nfdbits)
800{
801        int error;
802
803        if (uset != NULL) {
804                error = kern_sigprocmask(td, SIG_SETMASK, uset,
805                    &td->td_oldsigmask, 0);
806                if (error != 0)
807                        return (error);
808                td->td_pflags |= TDP_OLDMASK;
809                /*
810                 * Make sure that ast() is called on return to
811                 * usermode and TDP_OLDMASK is cleared, restoring old
812                 * sigmask.
813                 */
814                thread_lock(td);
815                td->td_flags |= TDF_ASTPENDING;
816                thread_unlock(td);
817        }
818        error = kern_select(td, nd, in, ou, ex, tvp, abi_nfdbits);
819        return (error);
820}
821
822#ifndef _SYS_SYSPROTO_H_
823struct select_args {
824        int     nd;
825        fd_set  *in, *ou, *ex;
826        struct  timeval *tv;
827};
828#endif
829int
830select(struct thread *td, struct select_args *uap)
831{
832        struct timeval tv, *tvp;
833        int error;
834
835        if (uap->tv != NULL) {
836                error = copyin(uap->tv, &tv, sizeof(tv));
837                if (error)
838                        return (error);
839                tvp = &tv;
840        } else
841                tvp = NULL;
842
843        return (kern_select(td, uap->nd, uap->in, uap->ou, uap->ex, tvp,
844            NFDBITS));
845}
846#endif /* __rtems__ */
847
848int
849kern_select(struct thread *td, int nd, fd_set *fd_in, fd_set *fd_ou,
850    fd_set *fd_ex, struct timeval *tvp, int abi_nfdbits)
851{
852        struct filedesc *fdp;
853        /*
854         * The magic 2048 here is chosen to be just enough for FD_SETSIZE
855         * infds with the new FD_SETSIZE of 1024, and more than enough for
856         * FD_SETSIZE infds, outfds and exceptfds with the old FD_SETSIZE
857         * of 256.
858         */
859        fd_mask s_selbits[howmany(2048, NFDBITS)];
860        fd_mask *ibits[3], *obits[3], *selbits, *sbp;
861        struct timeval atv, rtv, ttv;
862        int error, timo;
863        u_int nbufbytes, ncpbytes, ncpubytes, nfdbits;
864
865        if (nd < 0)
866                return (EINVAL);
867#ifndef __rtems__
868        fdp = td->td_proc->p_fd;
869        if (nd > fdp->fd_lastfile + 1)
870                nd = fdp->fd_lastfile + 1;
871#else /* __rtems__ */
872        (void) fdp;
873        if (nd > rtems_libio_number_iops)
874                nd = rtems_libio_number_iops;
875#endif /* __rtems__ */
876
877        /*
878         * Allocate just enough bits for the non-null fd_sets.  Use the
879         * preallocated auto buffer if possible.
880         */
881        nfdbits = roundup(nd, NFDBITS);
882        ncpbytes = nfdbits / NBBY;
883        ncpubytes = roundup(nd, abi_nfdbits) / NBBY;
884        nbufbytes = 0;
885        if (fd_in != NULL)
886                nbufbytes += 2 * ncpbytes;
887        if (fd_ou != NULL)
888                nbufbytes += 2 * ncpbytes;
889        if (fd_ex != NULL)
890                nbufbytes += 2 * ncpbytes;
891        if (nbufbytes <= sizeof s_selbits)
892                selbits = &s_selbits[0];
893        else
894                selbits = malloc(nbufbytes, M_SELECT, M_WAITOK);
895
896        /*
897         * Assign pointers into the bit buffers and fetch the input bits.
898         * Put the output buffers together so that they can be bzeroed
899         * together.
900         */
901        sbp = selbits;
902#define getbits(name, x) \
903        do {                                                            \
904                if (name == NULL) {                                     \
905                        ibits[x] = NULL;                                \
906                        obits[x] = NULL;                                \
907                } else {                                                \
908                        ibits[x] = sbp + nbufbytes / 2 / sizeof *sbp;   \
909                        obits[x] = sbp;                                 \
910                        sbp += ncpbytes / sizeof *sbp;                  \
911                        error = copyin(name, ibits[x], ncpubytes);      \
912                        if (error != 0)                                 \
913                                goto done;                              \
914                        bzero((char *)ibits[x] + ncpubytes,             \
915                            ncpbytes - ncpubytes);                      \
916                }                                                       \
917        } while (0)
918        getbits(fd_in, 0);
919        getbits(fd_ou, 1);
920        getbits(fd_ex, 2);
921#undef  getbits
922
923#if BYTE_ORDER == BIG_ENDIAN && defined(__LP64__)
924        /*
925         * XXX: swizzle_fdset assumes that if abi_nfdbits != NFDBITS,
926         * we are running under 32-bit emulation. This should be more
927         * generic.
928         */
929#define swizzle_fdset(bits)                                             \
930        if (abi_nfdbits != NFDBITS && bits != NULL) {                   \
931                int i;                                                  \
932                for (i = 0; i < ncpbytes / sizeof *sbp; i++)            \
933                        bits[i] = (bits[i] >> 32) | (bits[i] << 32);    \
934        }
935#else
936#define swizzle_fdset(bits)
937#endif
938
939        /* Make sure the bit order makes it through an ABI transition */
940        swizzle_fdset(ibits[0]);
941        swizzle_fdset(ibits[1]);
942        swizzle_fdset(ibits[2]);
943       
944        if (nbufbytes != 0)
945                bzero(selbits, nbufbytes / 2);
946
947        if (tvp != NULL) {
948                atv = *tvp;
949                if (itimerfix(&atv)) {
950                        error = EINVAL;
951                        goto done;
952                }
953                getmicrouptime(&rtv);
954                timevaladd(&atv, &rtv);
955        } else {
956                atv.tv_sec = 0;
957                atv.tv_usec = 0;
958        }
959        timo = 0;
960        seltdinit(td);
961        /* Iterate until the timeout expires or descriptors become ready. */
962        for (;;) {
963                error = selscan(td, ibits, obits, nd);
964                if (error || td->td_retval[0] != 0)
965                        break;
966                if (atv.tv_sec || atv.tv_usec) {
967                        getmicrouptime(&rtv);
968                        if (timevalcmp(&rtv, &atv, >=))
969                                break;
970                        ttv = atv;
971                        timevalsub(&ttv, &rtv);
972                        timo = ttv.tv_sec > 24 * 60 * 60 ?
973                            24 * 60 * 60 * hz : tvtohz(&ttv);
974                }
975                error = seltdwait(td, timo);
976                if (error)
977                        break;
978                error = selrescan(td, ibits, obits);
979                if (error || td->td_retval[0] != 0)
980                        break;
981        }
982        seltdclear(td);
983
984done:
985        /* select is not restarted after signals... */
986        if (error == ERESTART)
987                error = EINTR;
988        if (error == EWOULDBLOCK)
989                error = 0;
990
991        /* swizzle bit order back, if necessary */
992        swizzle_fdset(obits[0]);
993        swizzle_fdset(obits[1]);
994        swizzle_fdset(obits[2]);
995#undef swizzle_fdset
996
997#define putbits(name, x) \
998        if (name && (error2 = copyout(obits[x], name, ncpubytes))) \
999                error = error2;
1000        if (error == 0) {
1001                int error2;
1002
1003                putbits(fd_in, 0);
1004                putbits(fd_ou, 1);
1005                putbits(fd_ex, 2);
1006#undef putbits
1007        }
1008        if (selbits != &s_selbits[0])
1009                free(selbits, M_SELECT);
1010
1011        return (error);
1012}
1013#ifdef __rtems__
1014int
1015select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *errorfds,
1016    struct timeval *timeout)
1017{
1018        struct thread *td = rtems_bsd_get_curthread_or_null();
1019        int error;
1020
1021        if (td != NULL) {
1022                error = kern_select(td, nfds, readfds, writefds, errorfds,
1023                    timeout, NFDBITS);
1024        } else {
1025                error = ENOMEM;
1026        }
1027
1028        if (error == 0) {
1029                return td->td_retval[0];
1030        } else {
1031                rtems_set_errno_and_return_minus_one(error);
1032        }
1033}
1034#endif /* __rtems__ */
1035
1036/*
1037 * Convert a select bit set to poll flags.
1038 *
1039 * The backend always returns POLLHUP/POLLERR if appropriate and we
1040 * return this as a set bit in any set.
1041 */
1042static int select_flags[3] = {
1043    POLLRDNORM | POLLHUP | POLLERR,
1044    POLLWRNORM | POLLHUP | POLLERR,
1045    POLLRDBAND | POLLERR
1046};
1047
1048/*
1049 * Compute the fo_poll flags required for a fd given by the index and
1050 * bit position in the fd_mask array.
1051 */
1052static __inline int
1053selflags(fd_mask **ibits, int idx, fd_mask bit)
1054{
1055        int flags;
1056        int msk;
1057
1058        flags = 0;
1059        for (msk = 0; msk < 3; msk++) {
1060                if (ibits[msk] == NULL)
1061                        continue;
1062                if ((ibits[msk][idx] & bit) == 0)
1063                        continue;
1064                flags |= select_flags[msk];
1065        }
1066        return (flags);
1067}
1068
1069/*
1070 * Set the appropriate output bits given a mask of fired events and the
1071 * input bits originally requested.
1072 */
1073static __inline int
1074selsetbits(fd_mask **ibits, fd_mask **obits, int idx, fd_mask bit, int events)
1075{
1076        int msk;
1077        int n;
1078
1079        n = 0;
1080        for (msk = 0; msk < 3; msk++) {
1081                if ((events & select_flags[msk]) == 0)
1082                        continue;
1083                if (ibits[msk] == NULL)
1084                        continue;
1085                if ((ibits[msk][idx] & bit) == 0)
1086                        continue;
1087                /*
1088                 * XXX Check for a duplicate set.  This can occur because a
1089                 * socket calls selrecord() twice for each poll() call
1090                 * resulting in two selfds per real fd.  selrescan() will
1091                 * call selsetbits twice as a result.
1092                 */
1093                if ((obits[msk][idx] & bit) != 0)
1094                        continue;
1095                obits[msk][idx] |= bit;
1096                n++;
1097        }
1098
1099        return (n);
1100}
1101
1102/*
1103 * Traverse the list of fds attached to this thread's seltd and check for
1104 * completion.
1105 */
1106static int
1107selrescan(struct thread *td, fd_mask **ibits, fd_mask **obits)
1108{
1109        struct filedesc *fdp;
1110        struct selinfo *si;
1111        struct seltd *stp;
1112        struct selfd *sfp;
1113        struct selfd *sfn;
1114        struct file *fp;
1115        fd_mask bit;
1116        int fd, ev, n, idx;
1117
1118#ifndef __rtems__
1119        fdp = td->td_proc->p_fd;
1120#else /* __rtems__ */
1121        fdp = NULL;
1122#endif /* __rtems__ */
1123        stp = td->td_sel;
1124        n = 0;
1125        STAILQ_FOREACH_SAFE(sfp, &stp->st_selq, sf_link, sfn) {
1126                fd = (int)(uintptr_t)sfp->sf_cookie;
1127                si = sfp->sf_si;
1128                selfdfree(stp, sfp);
1129                /* If the selinfo wasn't cleared the event didn't fire. */
1130                if (si != NULL)
1131                        continue;
1132                if ((fp = fget_unlocked(fdp, fd)) == NULL)
1133                        return (EBADF);
1134                idx = fd / NFDBITS;
1135                bit = (fd_mask)1 << (fd % NFDBITS);
1136                ev = fo_poll(fp, selflags(ibits, idx, bit), td->td_ucred, td);
1137                fdrop(fp, td);
1138                if (ev != 0)
1139                        n += selsetbits(ibits, obits, idx, bit, ev);
1140        }
1141        stp->st_flags = 0;
1142        td->td_retval[0] = n;
1143        return (0);
1144}
1145
1146/*
1147 * Perform the initial filedescriptor scan and register ourselves with
1148 * each selinfo.
1149 */
1150static int
1151selscan(td, ibits, obits, nfd)
1152        struct thread *td;
1153        fd_mask **ibits, **obits;
1154        int nfd;
1155{
1156        struct filedesc *fdp;
1157        struct file *fp;
1158        fd_mask bit;
1159        int ev, flags, end, fd;
1160        int n, idx;
1161
1162#ifndef __rtems__
1163        fdp = td->td_proc->p_fd;
1164#else /* __rtems__ */
1165        fdp = NULL;
1166#endif /* __rtems__ */
1167        n = 0;
1168        for (idx = 0, fd = 0; fd < nfd; idx++) {
1169                end = imin(fd + NFDBITS, nfd);
1170                for (bit = 1; fd < end; bit <<= 1, fd++) {
1171                        /* Compute the list of events we're interested in. */
1172                        flags = selflags(ibits, idx, bit);
1173                        if (flags == 0)
1174                                continue;
1175                        if ((fp = fget_unlocked(fdp, fd)) == NULL)
1176                                return (EBADF);
1177                        selfdalloc(td, (void *)(uintptr_t)fd);
1178                        ev = fo_poll(fp, flags, td->td_ucred, td);
1179                        fdrop(fp, td);
1180                        if (ev != 0)
1181                                n += selsetbits(ibits, obits, idx, bit, ev);
1182                }
1183        }
1184
1185        td->td_retval[0] = n;
1186        return (0);
1187}
1188
1189#ifndef __rtems__
1190#ifndef _SYS_SYSPROTO_H_
1191struct poll_args {
1192        struct pollfd *fds;
1193        u_int   nfds;
1194        int     timeout;
1195};
1196#endif
1197int
1198poll(td, uap)
1199        struct thread *td;
1200        struct poll_args *uap;
1201{
1202        struct pollfd *bits;
1203        struct pollfd smallbits[32];
1204        struct timeval atv, rtv, ttv;
1205        int error = 0, timo;
1206        u_int nfds;
1207        size_t ni;
1208
1209        nfds = uap->nfds;
1210        if (nfds > maxfilesperproc && nfds > FD_SETSIZE) 
1211                return (EINVAL);
1212        ni = nfds * sizeof(struct pollfd);
1213        if (ni > sizeof(smallbits))
1214                bits = malloc(ni, M_TEMP, M_WAITOK);
1215        else
1216                bits = smallbits;
1217        error = copyin(uap->fds, bits, ni);
1218        if (error)
1219                goto done;
1220        if (uap->timeout != INFTIM) {
1221                atv.tv_sec = uap->timeout / 1000;
1222                atv.tv_usec = (uap->timeout % 1000) * 1000;
1223                if (itimerfix(&atv)) {
1224                        error = EINVAL;
1225                        goto done;
1226                }
1227                getmicrouptime(&rtv);
1228                timevaladd(&atv, &rtv);
1229        } else {
1230                atv.tv_sec = 0;
1231                atv.tv_usec = 0;
1232        }
1233        timo = 0;
1234        seltdinit(td);
1235        /* Iterate until the timeout expires or descriptors become ready. */
1236        for (;;) {
1237                error = pollscan(td, bits, nfds);
1238                if (error || td->td_retval[0] != 0)
1239                        break;
1240                if (atv.tv_sec || atv.tv_usec) {
1241                        getmicrouptime(&rtv);
1242                        if (timevalcmp(&rtv, &atv, >=))
1243                                break;
1244                        ttv = atv;
1245                        timevalsub(&ttv, &rtv);
1246                        timo = ttv.tv_sec > 24 * 60 * 60 ?
1247                            24 * 60 * 60 * hz : tvtohz(&ttv);
1248                }
1249                error = seltdwait(td, timo);
1250                if (error)
1251                        break;
1252                error = pollrescan(td);
1253                if (error || td->td_retval[0] != 0)
1254                        break;
1255        }
1256        seltdclear(td);
1257
1258done:
1259        /* poll is not restarted after signals... */
1260        if (error == ERESTART)
1261                error = EINTR;
1262        if (error == EWOULDBLOCK)
1263                error = 0;
1264        if (error == 0) {
1265                error = pollout(td, bits, uap->fds, nfds);
1266                if (error)
1267                        goto out;
1268        }
1269out:
1270        if (ni > sizeof(smallbits))
1271                free(bits, M_TEMP);
1272        return (error);
1273}
1274
1275static int
1276pollrescan(struct thread *td)
1277{
1278        struct seltd *stp;
1279        struct selfd *sfp;
1280        struct selfd *sfn;
1281        struct selinfo *si;
1282        struct filedesc *fdp;
1283        struct file *fp;
1284        struct pollfd *fd;
1285        int n;
1286
1287        n = 0;
1288        fdp = td->td_proc->p_fd;
1289        stp = td->td_sel;
1290        FILEDESC_SLOCK(fdp);
1291        STAILQ_FOREACH_SAFE(sfp, &stp->st_selq, sf_link, sfn) {
1292                fd = (struct pollfd *)sfp->sf_cookie;
1293                si = sfp->sf_si;
1294                selfdfree(stp, sfp);
1295                /* If the selinfo wasn't cleared the event didn't fire. */
1296                if (si != NULL)
1297                        continue;
1298                fp = fdp->fd_ofiles[fd->fd];
1299                if (fp == NULL) {
1300                        fd->revents = POLLNVAL;
1301                        n++;
1302                        continue;
1303                }
1304                /*
1305                 * Note: backend also returns POLLHUP and
1306                 * POLLERR if appropriate.
1307                 */
1308                fd->revents = fo_poll(fp, fd->events, td->td_ucred, td);
1309                if (fd->revents != 0)
1310                        n++;
1311        }
1312        FILEDESC_SUNLOCK(fdp);
1313        stp->st_flags = 0;
1314        td->td_retval[0] = n;
1315        return (0);
1316}
1317
1318
1319static int
1320pollout(td, fds, ufds, nfd)
1321        struct thread *td;
1322        struct pollfd *fds;
1323        struct pollfd *ufds;
1324        u_int nfd;
1325{
1326        int error = 0;
1327        u_int i = 0;
1328        u_int n = 0;
1329
1330        for (i = 0; i < nfd; i++) {
1331                error = copyout(&fds->revents, &ufds->revents,
1332                    sizeof(ufds->revents));
1333                if (error)
1334                        return (error);
1335                if (fds->revents != 0)
1336                        n++;
1337                fds++;
1338                ufds++;
1339        }
1340        td->td_retval[0] = n;
1341        return (0);
1342}
1343
1344static int
1345pollscan(td, fds, nfd)
1346        struct thread *td;
1347        struct pollfd *fds;
1348        u_int nfd;
1349{
1350        struct filedesc *fdp = td->td_proc->p_fd;
1351        int i;
1352        struct file *fp;
1353        int n = 0;
1354
1355        FILEDESC_SLOCK(fdp);
1356        for (i = 0; i < nfd; i++, fds++) {
1357                if (fds->fd >= fdp->fd_nfiles) {
1358                        fds->revents = POLLNVAL;
1359                        n++;
1360                } else if (fds->fd < 0) {
1361                        fds->revents = 0;
1362                } else {
1363                        fp = fdp->fd_ofiles[fds->fd];
1364                        if (fp == NULL) {
1365                                fds->revents = POLLNVAL;
1366                                n++;
1367                        } else {
1368                                /*
1369                                 * Note: backend also returns POLLHUP and
1370                                 * POLLERR if appropriate.
1371                                 */
1372                                selfdalloc(td, fds);
1373                                fds->revents = fo_poll(fp, fds->events,
1374                                    td->td_ucred, td);
1375                                /*
1376                                 * POSIX requires POLLOUT to be never
1377                                 * set simultaneously with POLLHUP.
1378                                 */
1379                                if ((fds->revents & POLLHUP) != 0)
1380                                        fds->revents &= ~POLLOUT;
1381
1382                                if (fds->revents != 0)
1383                                        n++;
1384                        }
1385                }
1386        }
1387        FILEDESC_SUNLOCK(fdp);
1388        td->td_retval[0] = n;
1389        return (0);
1390}
1391
1392/*
1393 * OpenBSD poll system call.
1394 *
1395 * XXX this isn't quite a true representation..  OpenBSD uses select ops.
1396 */
1397#ifndef _SYS_SYSPROTO_H_
1398struct openbsd_poll_args {
1399        struct pollfd *fds;
1400        u_int   nfds;
1401        int     timeout;
1402};
1403#endif
1404int
1405openbsd_poll(td, uap)
1406        register struct thread *td;
1407        register struct openbsd_poll_args *uap;
1408{
1409        return (poll(td, (struct poll_args *)uap));
1410}
1411
1412/*
1413 * XXX This was created specifically to support netncp and netsmb.  This
1414 * allows the caller to specify a socket to wait for events on.  It returns
1415 * 0 if any events matched and an error otherwise.  There is no way to
1416 * determine which events fired.
1417 */
1418int
1419selsocket(struct socket *so, int events, struct timeval *tvp, struct thread *td)
1420{
1421        struct timeval atv, rtv, ttv;
1422        int error, timo;
1423
1424        if (tvp != NULL) {
1425                atv = *tvp;
1426                if (itimerfix(&atv))
1427                        return (EINVAL);
1428                getmicrouptime(&rtv);
1429                timevaladd(&atv, &rtv);
1430        } else {
1431                atv.tv_sec = 0;
1432                atv.tv_usec = 0;
1433        }
1434
1435        timo = 0;
1436        seltdinit(td);
1437        /*
1438         * Iterate until the timeout expires or the socket becomes ready.
1439         */
1440        for (;;) {
1441                selfdalloc(td, NULL);
1442                error = sopoll(so, events, NULL, td);
1443                /* error here is actually the ready events. */
1444                if (error)
1445                        return (0);
1446                if (atv.tv_sec || atv.tv_usec) {
1447                        getmicrouptime(&rtv);
1448                        if (timevalcmp(&rtv, &atv, >=)) {
1449                                seltdclear(td);
1450                                return (EWOULDBLOCK);
1451                        }
1452                        ttv = atv;
1453                        timevalsub(&ttv, &rtv);
1454                        timo = ttv.tv_sec > 24 * 60 * 60 ?
1455                            24 * 60 * 60 * hz : tvtohz(&ttv);
1456                }
1457                error = seltdwait(td, timo);
1458                seltdclear(td);
1459                if (error)
1460                        break;
1461        }
1462        /* XXX Duplicates ncp/smb behavior. */
1463        if (error == ERESTART)
1464                error = 0;
1465        return (error);
1466}
1467#endif /* __rtems__ */
1468
1469/*
1470 * Preallocate two selfds associated with 'cookie'.  Some fo_poll routines
1471 * have two select sets, one for read and another for write.
1472 */
1473static void
1474selfdalloc(struct thread *td, void *cookie)
1475{
1476        struct seltd *stp;
1477
1478        stp = td->td_sel;
1479        if (stp->st_free1 == NULL)
1480                stp->st_free1 = uma_zalloc(selfd_zone, M_WAITOK|M_ZERO);
1481        stp->st_free1->sf_td = stp;
1482        stp->st_free1->sf_cookie = cookie;
1483        if (stp->st_free2 == NULL)
1484                stp->st_free2 = uma_zalloc(selfd_zone, M_WAITOK|M_ZERO);
1485        stp->st_free2->sf_td = stp;
1486        stp->st_free2->sf_cookie = cookie;
1487}
1488
1489static void
1490selfdfree(struct seltd *stp, struct selfd *sfp)
1491{
1492        STAILQ_REMOVE(&stp->st_selq, sfp, selfd, sf_link);
1493        mtx_lock(sfp->sf_mtx);
1494        if (sfp->sf_si)
1495                TAILQ_REMOVE(&sfp->sf_si->si_tdlist, sfp, sf_threads);
1496        mtx_unlock(sfp->sf_mtx);
1497        uma_zfree(selfd_zone, sfp);
1498}
1499
1500/*
1501 * Record a select request.
1502 */
1503void
1504selrecord(selector, sip)
1505        struct thread *selector;
1506        struct selinfo *sip;
1507{
1508        struct selfd *sfp;
1509        struct seltd *stp;
1510        struct mtx *mtxp;
1511
1512        stp = selector->td_sel;
1513        /*
1514         * Don't record when doing a rescan.
1515         */
1516        if (stp->st_flags & SELTD_RESCAN)
1517                return;
1518        /*
1519         * Grab one of the preallocated descriptors.
1520         */
1521        sfp = NULL;
1522        if ((sfp = stp->st_free1) != NULL)
1523                stp->st_free1 = NULL;
1524        else if ((sfp = stp->st_free2) != NULL)
1525                stp->st_free2 = NULL;
1526        else
1527                panic("selrecord: No free selfd on selq");
1528        mtxp = sip->si_mtx;
1529        if (mtxp == NULL)
1530                mtxp = mtx_pool_find(mtxpool_select, sip);
1531        /*
1532         * Initialize the sfp and queue it in the thread.
1533         */
1534        sfp->sf_si = sip;
1535        sfp->sf_mtx = mtxp;
1536        STAILQ_INSERT_TAIL(&stp->st_selq, sfp, sf_link);
1537        /*
1538         * Now that we've locked the sip, check for initialization.
1539         */
1540        mtx_lock(mtxp);
1541        if (sip->si_mtx == NULL) {
1542                sip->si_mtx = mtxp;
1543                TAILQ_INIT(&sip->si_tdlist);
1544        }
1545        /*
1546         * Add this thread to the list of selfds listening on this selinfo.
1547         */
1548        TAILQ_INSERT_TAIL(&sip->si_tdlist, sfp, sf_threads);
1549        mtx_unlock(sip->si_mtx);
1550}
1551
1552/* Wake up a selecting thread. */
1553void
1554selwakeup(sip)
1555        struct selinfo *sip;
1556{
1557        doselwakeup(sip, -1);
1558}
1559
1560/* Wake up a selecting thread, and set its priority. */
1561void
1562selwakeuppri(sip, pri)
1563        struct selinfo *sip;
1564        int pri;
1565{
1566        doselwakeup(sip, pri);
1567}
1568
1569/*
1570 * Do a wakeup when a selectable event occurs.
1571 */
1572static void
1573doselwakeup(sip, pri)
1574        struct selinfo *sip;
1575        int pri;
1576{
1577        struct selfd *sfp;
1578        struct selfd *sfn;
1579        struct seltd *stp;
1580
1581        /* If it's not initialized there can't be any waiters. */
1582        if (sip->si_mtx == NULL)
1583                return;
1584        /*
1585         * Locking the selinfo locks all selfds associated with it.
1586         */
1587        mtx_lock(sip->si_mtx);
1588        TAILQ_FOREACH_SAFE(sfp, &sip->si_tdlist, sf_threads, sfn) {
1589                /*
1590                 * Once we remove this sfp from the list and clear the
1591                 * sf_si seltdclear will know to ignore this si.
1592                 */
1593                TAILQ_REMOVE(&sip->si_tdlist, sfp, sf_threads);
1594                sfp->sf_si = NULL;
1595                stp = sfp->sf_td;
1596                mtx_lock(&stp->st_mtx);
1597                stp->st_flags |= SELTD_PENDING;
1598                cv_broadcastpri(&stp->st_wait, pri);
1599                mtx_unlock(&stp->st_mtx);
1600        }
1601        mtx_unlock(sip->si_mtx);
1602}
1603
1604static void
1605seltdinit(struct thread *td)
1606{
1607        struct seltd *stp;
1608
1609        if ((stp = td->td_sel) != NULL)
1610                goto out;
1611        td->td_sel = stp = malloc(sizeof(*stp), M_SELECT, M_WAITOK|M_ZERO);
1612        mtx_init(&stp->st_mtx, "sellck", NULL, MTX_DEF);
1613        cv_init(&stp->st_wait, "select");
1614out:
1615        stp->st_flags = 0;
1616        STAILQ_INIT(&stp->st_selq);
1617}
1618
1619static int
1620seltdwait(struct thread *td, int timo)
1621{
1622        struct seltd *stp;
1623        int error;
1624
1625        stp = td->td_sel;
1626        /*
1627         * An event of interest may occur while we do not hold the seltd
1628         * locked so check the pending flag before we sleep.
1629         */
1630        mtx_lock(&stp->st_mtx);
1631        /*
1632         * Any further calls to selrecord will be a rescan.
1633         */
1634        stp->st_flags |= SELTD_RESCAN;
1635        if (stp->st_flags & SELTD_PENDING) {
1636                mtx_unlock(&stp->st_mtx);
1637                return (0);
1638        }
1639        if (timo > 0)
1640                error = cv_timedwait_sig(&stp->st_wait, &stp->st_mtx, timo);
1641        else
1642                error = cv_wait_sig(&stp->st_wait, &stp->st_mtx);
1643        mtx_unlock(&stp->st_mtx);
1644
1645        return (error);
1646}
1647
1648void
1649seltdfini(struct thread *td)
1650{
1651        struct seltd *stp;
1652
1653        stp = td->td_sel;
1654        if (stp == NULL)
1655                return;
1656        if (stp->st_free1)
1657                uma_zfree(selfd_zone, stp->st_free1);
1658        if (stp->st_free2)
1659                uma_zfree(selfd_zone, stp->st_free2);
1660        td->td_sel = NULL;
1661        free(stp, M_SELECT);
1662}
1663
1664/*
1665 * Remove the references to the thread from all of the objects we were
1666 * polling.
1667 */
1668static void
1669seltdclear(struct thread *td)
1670{
1671        struct seltd *stp;
1672        struct selfd *sfp;
1673        struct selfd *sfn;
1674
1675        stp = td->td_sel;
1676        STAILQ_FOREACH_SAFE(sfp, &stp->st_selq, sf_link, sfn)
1677                selfdfree(stp, sfp);
1678        stp->st_flags = 0;
1679}
1680
1681static void selectinit(void *);
1682SYSINIT(select, SI_SUB_SYSCALLS, SI_ORDER_ANY, selectinit, NULL);
1683static void
1684selectinit(void *dummy __unused)
1685{
1686
1687        selfd_zone = uma_zcreate("selfd", sizeof(struct selfd), NULL, NULL,
1688            NULL, NULL, UMA_ALIGN_PTR, 0);
1689        mtxpool_select = mtx_pool_create("select mtxpool", 128, MTX_DEF);
1690}
Note: See TracBrowser for help on using the repository browser.