rom/hidds/ata_pci/timer.c

   1 /*
   2     Copyright © 2009-2013, The AROS Development Team. All rights reserved
   3     $Id$
   4
   5     Desc:
   6     Lang: English
   7 */
   8
   9 #include <devices/timer.h>
  10 #include <exec/io.h>
  11 #include <proto/exec.h>
  12 #include <aros/debug.h>
  13 #include <proto/timer.h>
  14
  15 #include "timer.h"
  16 #include "ata.h"
  17
  18 struct IORequest *ata_OpenTimer(void)
  19 {
  20     struct MsgPort *p = CreateMsgPort();
  21
  22     if (NULL != p)
  23     {
  24         struct IORequest *io = CreateIORequest(p, sizeof(struct timerequest));
  25
  26         if (NULL != io)
  27         {
  28             if (0 == OpenDevice("timer.device", UNIT_MICROHZ, io, 0))
  29             {
  30                 return io;
  31             }
  32             DeleteIORequest(io);
  33         }
  34         DeleteMsgPort(p);
  35     }
  36
  37     return NULL;
  38 }
  39
  40 void ata_CloseTimer(struct IORequest *tmr)
  41 {
  42     if (NULL != tmr)
  43     {
  44         struct MsgPort *p = tmr->io_Message.mn_ReplyPort;
  45
  46         CloseDevice(tmr);
  47         DeleteIORequest(tmr);
  48         DeleteMsgPort(p);
  49     }
  50 }
  51
  52 void ata_WaitTO(struct IORequest* tmr, ULONG secs, ULONG micro)
  53 {
  54     tmr->io_Command = TR_ADDREQUEST;
  55     ((struct timerequest*)tmr)->tr_time.tv_secs = secs;
  56     ((struct timerequest*)tmr)->tr_time.tv_micro = micro;
  57
  58     DoIO(tmr);
  59 }