timeLib.c 3.19 KB
Newer Older
pixhawk's avatar
pixhawk committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
/*****************************************************************************
 *  Copyright (c) 2008, University of Florida
 *  All rights reserved.
 *  
 *  This file is part of OpenJAUS.  OpenJAUS is distributed under the BSD 
 *  license.  See the LICENSE file for details.
 * 
 *  Redistribution and use in source and binary forms, with or without 
 *  modification, are permitted provided that the following conditions 
 *  are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above
 *       copyright notice, this list of conditions and the following
 *       disclaimer in the documentation and/or other materials provided
 *       with the distribution.
 *     * Neither the name of the University of Florida nor the names of its 
 *       contributors may be used to endorse or promote products derived from 
 *       this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 
 *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 ****************************************************************************/
// File Name: timeLib.c
//
// Written by: Tom Galluzzo (galluzzo AT gmail DOT com)
//
// Version: 3.3.0a
//
// Date: 08/07/08
//
// Description:	CIMAR timing library header file

#include "utils/timeLib.h"

#ifdef WIN32
	#include <time.h>
	#include <windows.h>
	
	double getTimeSeconds(void)
	{
		static char init = 0;
		static TIMECAPS timerInfo;
		
		if(!init)
		{
			timeGetDevCaps(&timerInfo, sizeof(TIMECAPS));
			timeBeginPeriod(timerInfo.wPeriodMin);
			init = 1;
		}	
		
		return (double) (timeGetTime() / 1000.0);
	}

	double ojGetTimeSec(void)
	{
		// TODO: the following code could have a 1 second inaccuracy if a second transition occurs after the GetSystemTime call
		SYSTEMTIME st;
		GetSystemTime(&st);
		return time(NULL) + st.wMilliseconds / 1000.0;
	}
	
	void ojSleepMsec(int msec)
	{
		Sleep(msec);
	}

#else

	#include <sys/time.h>
	#include <time.h>
	#include <unistd.h>

	double getTimeSeconds(void)
	{
	      static struct timeval time;
	      
	      gettimeofday(&time, NULL);
	      
	      return (double)time.tv_sec + (double)time.tv_usec/1.0e6;
	}

	double ojGetTimeSec(void)
	{
		  static struct timeval time;
	      
		  gettimeofday(&time, NULL);
	      
		  return (double)time.tv_sec + (double)time.tv_usec/1.0e6;
	}

	void ojSleepMsec(int msec)
	{
		usleep(msec * 1000);
	}

#endif