sysdeps/mach/nanosleep.c

   1 /* nanosleep -- sleep for a period specified with a struct timespec
   2    Copyright (C) 2002-2017 Free Software Foundation, Inc.
   3    This file is part of the GNU C Library.
   4
   5    The GNU C Library is free software; you can redistribute it and/or
   6    modify it under the terms of the GNU Lesser General Public
   7    License as published by the Free Software Foundation; either
   8    version 2.1 of the License, or (at your option) any later version.
   9
  10    The GNU C Library is distributed in the hope that it will be useful,
  11    but WITHOUT ANY WARRANTY; without even the implied warranty of
  12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13    Lesser General Public License for more details.
  14
  15    You should have received a copy of the GNU Lesser General Public
  16    License along with the GNU C Library; if not, see
  17    <http://www.gnu.org/licenses/>.  */
  18
  19 #include <errno.h>
  20 #include <mach.h>
  21 #include <sys/time.h>
  22 #include <time.h>
  23 #include <unistd.h>
  24
  25 int
  26 __libc_nanosleep (const struct timespec *requested_time,
  27              struct timespec *remaining)
  28 {
  29   mach_port_t recv;
  30   struct timeval before, after;
  31
  32   if (requested_time->tv_sec < 0
  33       || requested_time->tv_nsec < 0
  34       || requested_time->tv_nsec >= 1000000000)
  35     {
  36       errno = EINVAL;
  37       return -1;
  38     }
  39
  40   const mach_msg_timeout_t ms
  41     = requested_time->tv_sec * 1000
  42     + (requested_time->tv_nsec + 999999) / 1000000;
  43
  44   recv = __mach_reply_port ();
  45
  46   if (remaining && __gettimeofday (&before, NULL) < 0)
  47     return -1;
  48   error_t err = __mach_msg (NULL, MACH_RCV_MSG|MACH_RCV_TIMEOUT|MACH_RCV_INTERRUPT,
  49                             0, 0, recv, ms, MACH_PORT_NULL);
  50   __mach_port_destroy (mach_task_self (), recv);
  51   if (err == EMACH_RCV_INTERRUPTED)
  52     {
  53       if (remaining && __gettimeofday (&after, NULL) >= 0)
  54         {
  55           struct timeval req_time, elapsed, rem;
  56           TIMESPEC_TO_TIMEVAL (&req_time, requested_time);
  57           timersub (&after, &before, &elapsed);
  58           timersub (&req_time, &elapsed, &rem);
  59           TIMEVAL_TO_TIMESPEC (&rem, remaining);
  60         }
  61
  62       errno = EINTR;
  63       return -1;
  64     }
  65
  66   return 0;
  67 }
  68 weak_alias(__libc_nanosleep, __nanosleep)
  69 libc_hidden_def (__nanosleep)
  70 weak_alias (__libc_nanosleep, nanosleep)