workbench/devs/networks/prism2/timer.c

   1 /*
   2
   3 Copyright (C) 2012 Neil Cafferkey
   4
   5 This program is free software; you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation; either version 2 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful, but
  11 WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13 General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program; if not, write to the Free Software
  17 Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  18 MA 02111-1307, USA.
  19
  20 */
  21
  22
  23 #include <proto/timer.h>
  24
  25 #include "device.h"
  26
  27 #include "timer_protos.h"
  28
  29
  30 /****i* prism2.device/BusyMilliDelay ***************************************
  31 *
  32 *   NAME
  33 *       BusyMilliDelay - Busy-wait for specified number of milliseconds.
  34 *
  35 *   SYNOPSIS
  36 *       BusyMilliDelay(millis)
  37 *
  38 *       VOID BusyMilliDelay(ULONG);
  39 *
  40 ****************************************************************************
  41 *
  42 */
  43
  44 VOID BusyMilliDelay(ULONG millis, struct DevBase *base)
  45 {
  46    struct timeval time, end_time;
  47
  48    GetSysTime(&end_time);
  49    time.tv_secs = 0;
  50    time.tv_micro = millis * 1000;
  51    AddTime(&end_time, &time);
  52
  53    while(CmpTime(&end_time, &time) < 0)
  54       GetSysTime(&time);
  55
  56    return;
  57 }
  58
  59
  60