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
|
#define _POSIX_C_SOURCE 200112L
#define _GNU_SOURCE
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include <stdint.h>
#include <assert.h>
#include <ctype.h>
#include <time.h>
#include <sched.h>
#include <arpa/inet.h>
#include <sys/time.h>
#include "pci.h"
#include "tools.h"
#include "error.h"
int pcilib_add_timeout(struct timeval *tv, pcilib_timeout_t timeout) {
tv->tv_usec += timeout%1000000;
if (tv->tv_usec > 999999) {
tv->tv_usec -= 1000000;
tv->tv_sec += 1 + timeout/1000000;
} else {
tv->tv_sec += timeout/1000000;
}
return 0;
}
int pcilib_calc_deadline(struct timeval *tv, pcilib_timeout_t timeout) {
gettimeofday(tv, NULL);
pcilib_add_timeout(tv, timeout);
return 0;
}
int pcilib_check_deadline(struct timeval *tve, pcilib_timeout_t timeout) {
int64_t res;
struct timeval tvs;
if (!tve->tv_sec) return 0;
gettimeofday(&tvs, NULL);
res = ((tve->tv_sec - tvs.tv_sec)*1000000 + (tve->tv_usec - tvs.tv_usec));
// Hm... Some problems comparing signed and unsigned. So, sign check first
if ((res < 0)||(res < timeout)) {
return 1;
}
return 0;
}
pcilib_timeout_t pcilib_calc_time_to_deadline(struct timeval *tve) {
int64_t res;
struct timeval tvs;
gettimeofday(&tvs, NULL);
res = ((tve->tv_sec - tvs.tv_sec)*1000000 + (tve->tv_usec - tvs.tv_usec));
if (res < 0) return 0;
return res;
}
int pcilib_sleep_until_deadline(struct timeval *tv) {
struct timespec wait;
pcilib_timeout_t duration;
duration = pcilib_calc_time_to_deadline(tv);
if (duration > 0) {
wait.tv_sec = duration / 1000000;
wait.tv_nsec = 1000 * (duration % 1000000);
nanosleep(&wait, NULL);
}
return 0;
}
pcilib_timeout_t pcilib_timediff(struct timeval *tvs, struct timeval *tve) {
return ((tve->tv_sec - tvs->tv_sec)*1000000 + (tve->tv_usec - tvs->tv_usec));
}
int pcilib_timecmp(struct timeval *tv1, struct timeval *tv2) {
if (tv1->tv_sec > tv2->tv_sec) return 1;
else if (tv1->tv_sec < tv2->tv_sec) return -1;
else if (tv1->tv_usec > tv2->tv_usec) return 1;
else if (tv1->tv_usec < tv2->tv_usec) return -1;
return 0;
}
|