compiler/posixc/nanosleep.c

   1 /*
   2     Copyright © 2008-2012, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     POSIX.1-2008 function nanosleep().
   6 */
   7 #include <exec/exec.h>
   8 #include <proto/exec.h>
   9 #include <devices/timer.h>
  10
  11 #include <unistd.h>
  12
  13 /*****************************************************************************
  14
  15     NAME */
  16 #include <time.h>
  17
  18         int nanosleep (
  19
  20 /*  SYNOPSIS */
  21         const struct timespec * req, struct timespec *rem)
  22
  23 /*  FUNCTION
  24         Suspends program execution for a given number of nanoseconds.
  25
  26     INPUTS
  27         req - time to wait
  28         rem - remaining time, if nanosleep was interrupted by a signal
  29
  30     RESULT
  31         0 on success, -1 on error
  32
  33     NOTES
  34         Currently at most a resolution of milliseconds is supported.
  35
  36     EXAMPLE
  37
  38     BUGS
  39
  40     SEE ALSO
  41
  42     INTERNALS
  43
  44 ******************************************************************************/
  45 {
  46     struct MsgPort      *timerMsgPort;
  47     struct timerequest  *timerIO;
  48     int retval = -1;
  49
  50     /* FIXME: share TimerBase with gettimeofday and don't open/close it for each usleep call */
  51     if((timerMsgPort = CreateMsgPort()))
  52     {
  53         timerIO = (struct timerequest *) CreateIORequest(timerMsgPort, sizeof (struct timerequest));
  54         if(timerIO)
  55         {
  56             if(OpenDevice("timer.device", UNIT_MICROHZ, (struct IORequest *) timerIO, 0) == 0)
  57             {
  58                 timerIO->tr_node.io_Command = TR_ADDREQUEST;
  59                 timerIO->tr_time.tv_secs    = req->tv_sec;
  60                 timerIO->tr_time.tv_micro   = (req->tv_nsec+500)/1000;
  61
  62                 DoIO((struct IORequest *) timerIO);
  63                 retval = 0;
  64
  65                 if (rem)
  66                 {
  67                     rem->tv_sec = 0;
  68                     rem->tv_nsec = 0;
  69                 }
  70
  71                 CloseDevice((struct IORequest *) timerIO);
  72             }
  73             DeleteIORequest((struct IORequest *) timerIO);
  74         }
  75         DeleteMsgPort(timerMsgPort);
  76     }
  77     return retval;
  78 } /* nanosleep() */
  79