2001-02-24 20:28:24 +00:00
|
|
|
// Precise timer routines for LINUX (C) LGB & A'rpi/ASTRAL
|
|
|
|
|
|
|
|
#include <unistd.h>
|
2001-10-25 23:34:14 +00:00
|
|
|
#include <time.h>
|
2001-02-24 20:28:24 +00:00
|
|
|
#include <sys/time.h>
|
|
|
|
|
2001-10-19 02:16:21 +00:00
|
|
|
int usec_sleep(int usec_delay)
|
|
|
|
{
|
|
|
|
#if 1
|
|
|
|
struct timespec ts;
|
|
|
|
ts.tv_sec = usec_delay / 1000000;
|
|
|
|
ts.tv_nsec = (usec_delay % 1000000) * 1000;
|
|
|
|
return nanosleep(&ts, NULL);
|
|
|
|
#else
|
|
|
|
return usleep(usec_delay);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2001-03-13 00:13:18 +00:00
|
|
|
// Returns current time in microseconds
|
2001-02-24 20:28:24 +00:00
|
|
|
unsigned int GetTimer(){
|
|
|
|
struct timeval tv;
|
|
|
|
struct timezone tz;
|
|
|
|
// float s;
|
|
|
|
gettimeofday(&tv,&tz);
|
|
|
|
// s=tv.tv_usec;s*=0.000001;s+=tv.tv_sec;
|
|
|
|
return (tv.tv_sec*1000000+tv.tv_usec);
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned int RelativeTime=0;
|
|
|
|
|
|
|
|
// Returns time spent between now and last call in seconds
|
|
|
|
float GetRelativeTime(){
|
|
|
|
unsigned int t,r;
|
|
|
|
t=GetTimer();
|
|
|
|
// t*=16;printf("time=%ud\n",t);
|
|
|
|
r=t-RelativeTime;
|
|
|
|
RelativeTime=t;
|
|
|
|
return (float)r * 0.000001F;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Initialize timer, must be called at least once at start
|
|
|
|
void InitTimer(){
|
|
|
|
GetRelativeTime();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
void main(){
|
|
|
|
float t=0;
|
|
|
|
InitTimer();
|
|
|
|
while(1){ t+=GetRelativeTime();printf("time= %10.6f\r",t);fflush(stdout); }
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|