compiler/clib/usleep.c

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