blob: 79396ec9d08ed28eda5b50a3edd6880f52f81eef (
plain)
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
|
// Precise timer routines for LINUX (C) LGB & A'rpi/ASTRAL
#include <unistd.h>
#include <time.h>
#include <sys/time.h>
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
}
// Returns current time in microseconds
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
|