lib/libkse/thread/thr_poll.c

   1 /*
   2  * Copyright (c) 1999 Daniel Eischen <eischen@vigrid.com>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. All advertising materials mentioning features or use of this software
  14  *    must display the following acknowledgement:
  15  *      This product includes software developed by Daniel Eischen.
  16  * 4. Neither the name of the author nor the names of any co-contributors
  17  *    may be used to endorse or promote products derived from this software
  18  *    without specific prior written permission.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY DANIEL EISCHEN AND CONTRIBUTORS ``AS IS'' AND
  21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  30  * SUCH DAMAGE.
  31  *
  32  * $FreeBSD$
  33  */
  34 #include <unistd.h>
  35 #include <errno.h>
  36 #include <string.h>
  37 #include <poll.h>
  38 #include <sys/types.h>
  39 #include <sys/time.h>
  40 #include <sys/fcntl.h>
  41 #ifdef _THREAD_SAFE
  42 #include <pthread.h>
  43 #include "pthread_private.h"
  44
  45
  46 int
  47 poll(struct pollfd *fds, unsigned int nfds, int timeout)
  48 {
  49         struct timespec ts;
  50         int             numfds = nfds;
  51         int             i, ret = 0, found = 0;
  52         struct pthread_poll_data data;
  53
  54         if (numfds > _thread_dtablesize) {
  55                 numfds = _thread_dtablesize;
  56         }
  57         /* Check if a timeout was specified: */
  58         if (timeout == INFTIM) {
  59                 /* Wait for ever: */
  60                 _thread_kern_set_timeout(NULL);
  61         } else if (timeout > 0) {
  62                 /* Convert the timeout in msec to a timespec: */
  63                 ts.tv_sec = timeout / 1000;
  64                 ts.tv_nsec = (timeout % 1000) * 1000;
  65
  66                 /* Set the wake up time: */
  67                 _thread_kern_set_timeout(&ts);
  68         } else if (timeout < 0) {
  69                 /* a timeout less than zero but not == INFTIM is invalid */
  70                 errno = EINVAL;
  71                 return (-1);
  72         }
  73
  74         if (((ret = _thread_sys_poll(fds, numfds, 0)) == 0) && (timeout != 0)) {
  75                 data.nfds = numfds;
  76                 data.fds = fds;
  77
  78                 /*
  79                  * Clear revents in case of a timeout which leaves fds
  80                  * unchanged:
  81                  */
  82                 for (i = 0; i < numfds; i++) {
  83                         fds[i].revents = 0;
  84                 }
  85
  86                 _thread_run->data.poll_data = &data;
  87                 _thread_run->interrupted = 0;
  88                 _thread_kern_sched_state(PS_POLL_WAIT, __FILE__, __LINE__);
  89                 if (_thread_run->interrupted) {
  90                         errno = EINTR;
  91                         ret = -1;
  92                 } else {
  93                         ret = data.nfds;
  94                 }
  95         }
  96
  97         return (ret);
  98 }
  99 #endif