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
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
#include <stdio.h>
#include "../machine.h"
#ifndef WIN32
#include <sys/time.h>
#include <unistd.h>
#ifndef __GNUC__
#define inline
#endif
static inline unsigned long long TIME2ULL(t)
struct timeval t;
{
unsigned long long result;
result = (unsigned long long)t.tv_sec * 1000000 + t.tv_usec;
return result;
}
static inline struct timeval ULL2TIME(t)
unsigned long long t;
{
struct timeval result;
result.tv_sec = t / 1000000;
result.tv_usec = t % 1000000;
return result;
}
static double simulation_start = 0;
static double simulation_scale = 0;
static unsigned long long realtime_start = 0;
static int simulation_doinit = 1;
int C2F(realtimeinit)(t,scale)
double *t;
double *scale;
{
struct timeval now;
gettimeofday(&now, 0);
/* printf("Realtime init %f %f\n", *t, *scale);*/
realtime_start = TIME2ULL(now);
simulation_doinit = 1;
simulation_scale = *scale;
return 0;
}
int C2F(realtime)(t)
double *t;
{
struct timeval now;
unsigned long long realtime_diff;
double simulation_diff;
long long delay;
if (simulation_doinit) {
simulation_doinit = 0;
simulation_start = *t;
}
gettimeofday(&now, 0);
realtime_diff = TIME2ULL(now) - realtime_start;
simulation_diff = (*t - simulation_start) * simulation_scale;
delay = (long long)(simulation_diff * 1000000) - realtime_diff;
/* printf("Realtime diff %Ld %f -> %Ld (t=%f)\n",
realtime_diff, simulation_diff, delay, *t);
*/
if (delay > 0) {
struct timeval d ;
d = ULL2TIME(delay);
select(0, 0, 0, 0, &d);
}
return 0;
}
#else
#include <windows.h>
static double simulation_start = 0;
static double simulation_scale = 0;
static __int64 realtime_start = 0;
static int simulation_doinit = 1;
union {FILETIME ftFileTime;
__int64 ftInt64;
} ftRealTime;
int C2F(realtimeinit)(double *t, double *scale) {
SYSTEMTIME st;
GetSystemTime(&st);
SystemTimeToFileTime(&st,&ftRealTime.ftFileTime);
realtime_start = ftRealTime.ftInt64;
simulation_doinit = 1;
simulation_scale = *scale;
return 0;
}
int C2F(realtime)(double *t) {
__int64 realtime_diff;
double simulation_diff;
__int64 delay;
SYSTEMTIME st;
if (simulation_doinit) {
simulation_doinit = 0;
simulation_start = *t;
}
GetSystemTime(&st);
SystemTimeToFileTime(&st,&ftRealTime.ftFileTime);
realtime_diff = ftRealTime.ftInt64 - realtime_start;
simulation_diff = (*t - simulation_start) * simulation_scale;
delay = (__int64)(simulation_diff * 10000000) - realtime_diff;
/* printf("Realtime diff %Ld %f -> %Ld (t=%f)\n",
realtime_diff, simulation_diff, delay, *t);
*/
if (delay > 0) {
Sleep((DWORD)(delay/10000));
}
return 0;
}
#endif
|
