rom/devs/scsi/waitto.c

   1 /*
   2     Copyright © 2013-2014, The AROS Development Team. All rights reserved
   3     $Id: waitto.c 55802 2019-03-08 21:47:59Z wawa $
   4 */
   5
   6 #include <aros/debug.h>
   7
   8 #include <proto/exec.h>
   9
  10 /* We want all other bases obtained from our base */
  11 #define __NOLIBBASE__
  12
  13 #include <proto/timer.h>
  14
  15 #include <exec/types.h>
  16 #include <devices/timer.h>
  17 #include <exec/io.h>
  18
  19 #include "timer.h"
  20 #include "scsi.h"
  21
  22 /* Waits for a signal or a timeout */
  23 ULONG scsi_WaitTO(struct IORequest* tmr, ULONG secs, ULONG micro, ULONG sigs)
  24 {
  25     ULONG sig = 1 << tmr->io_Message.mn_ReplyPort->mp_SigBit;
  26
  27     D(struct Node *t = (struct Node *)FindTask(NULL));
  28     D(bug("[SCSI  ] Timed wait %lds %ldu (task='%s')\n", secs, micro,
  29         t->ln_Name));
  30
  31     tmr->io_Command = TR_ADDREQUEST;
  32     ((struct timerequest*)tmr)->tr_time.tv_secs = secs;
  33     ((struct timerequest*)tmr)->tr_time.tv_micro = micro;
  34
  35     SendIO(tmr);
  36     D(bug("[SCSI  ] Preset signals: %lx ('%s')\n", SetSignal(0, 0), t->ln_Name));
  37     D(bug("[SCSI  ] Signals requested: %lx ('%s')\n", sigs, t->ln_Name));
  38     D(bug("[SCSI  ] Timer signal: %lx ('%s')\n", sig, t->ln_Name));
  39     sigs = Wait(sigs | sig);
  40     D(bug("[SCSI  ] Signals received: %lx ('%s')\n", sigs, t->ln_Name));
  41     if (0 == (sigs & sig))
  42     {
  43         if (!CheckIO(tmr))
  44             AbortIO(tmr);
  45     }
  46     WaitIO(tmr);
  47
  48     SetSignal(0, sig);
  49
  50     return sigs & ~sig;
  51 }