arch/arm-raspi/devs/sdcard/timer.c

   1 /*
   2     Copyright © 2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7 #include <aros/debug.h>
   8
   9 #include <exec/types.h>
  10 #include <devices/timer.h>
  11 #include <exec/io.h>
  12 #include <proto/exec.h>
  13 #include <aros/debug.h>
  14 #include <proto/timer.h>
  15
  16 #include "timer.h"
  17 #include "sdcard_intern.h"
  18
  19 struct IORequest *sdcard_OpenTimer(struct SDCardBase *SDCardBase)
  20 {
  21     struct MsgPort *p = CreateMsgPort();
  22     if (NULL != p)
  23     {
  24         struct IORequest *io = CreateIORequest(p, sizeof(struct timerequest));
  25
  26         if (NULL != io)
  27         {
  28             /*
  29              * ok. ECLOCK does not have too great resolution, either.
  30              * we will have to sacrifice our performance a little bit, meaning, the 400ns will turn into (worst case) 2us.
  31              * hopefully we won't have to call that TOO often...
  32              */
  33             if (0 == OpenDevice("timer.device", UNIT_MICROHZ, io, 0))
  34             {
  35                 if (NULL == SDCardBase->sdcard_TimerBase)
  36                 {
  37                     SDCardBase->sdcard_TimerBase = io->io_Device;
  38                 }
  39                 return io;
  40             }
  41             else
  42             {
  43                 bug("[SDCard  ] Failed to open timer.device, unit MICROHZ\n");
  44             }
  45             DeleteIORequest(io);
  46         }
  47         else
  48         {
  49             bug("[SDCard  ] Failed to create timerequest\n");
  50         }
  51         DeleteMsgPort(p);
  52     }
  53     else
  54     {
  55         bug("[SDCard  ] Failed to create timer port\n");
  56     }
  57
  58     return NULL;
  59 }
  60
  61 void sdcard_CloseTimer(struct IORequest *tmr)
  62 {
  63     if (NULL != tmr)
  64     {
  65         struct MsgPort *p = tmr->io_Message.mn_ReplyPort;
  66         CloseDevice(tmr);
  67         DeleteIORequest(tmr);
  68         DeleteMsgPort(p);
  69     }
  70 }
  71
  72 void sdcard_WaitNano(register ULONG ns, struct SDCardBase *SDCardBase)
  73 {
  74     volatile register ULONG t = 1;
  75     while (ns > 0)
  76     {
  77         asm volatile("mov r0, r0\n");
  78         --ns;
  79     }
  80 }
  81
  82 ULONG sdcard_WaitTO(struct IORequest* tmr, ULONG secs, ULONG micro, ULONG sigs)
  83 {
  84     ULONG sig = 1 << tmr->io_Message.mn_ReplyPort->mp_SigBit;
  85
  86     //D(bug("[SDCard--] Timed wait %lds %ldu\n", secs, micro));
  87
  88     tmr->io_Command = TR_ADDREQUEST;
  89     ((struct timerequest*)tmr)->tr_time.tv_secs = secs;
  90     ((struct timerequest*)tmr)->tr_time.tv_micro = micro;
  91
  92     SendIO(tmr);
  93     sigs = Wait(sigs | sig);
  94     if (0 == (sigs & sig))
  95     {
  96         if (!CheckIO(tmr))
  97             AbortIO(tmr);
  98     }
  99     WaitIO(tmr);
 100
 101     SetSignal(0, sig);
 102
 103     return sigs &~ sig;
 104 }
 105