blob: ada9076a75875ea7b89dd8463a402f653c9f1d72 (
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
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
|
/* $Id$
*
*/
#include <pj/os.h>
#include <pj/errno.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <ctype.h>
#if defined(PJ_HAS_PENTIUM) && PJ_HAS_PENTIUM!=0
static int machine_speed_mhz;
static pj_timestamp machine_speed;
static __inline__ unsigned long long int rdtsc()
{
unsigned long long int x;
__asm__ volatile (".byte 0x0f, 0x31" : "=A" (x));
return x;
}
/* Determine machine's CPU MHz to get the counter's frequency.
*/
static int get_machine_speed_mhz()
{
FILE *strm;
char buf[512];
int len;
char *pos, *end;
PJ_CHECK_STACK();
/* Open /proc/cpuinfo and read the file */
strm = fopen("/proc/cpuinfo", "r");
if (!strm)
return -1;
len = fread(buf, 1, sizeof(buf), strm);
fclose(strm);
if (len < 1) {
return -1;
}
buf[len] = '\0';
/* Locate the MHz digit. */
pos = strstr(buf, "cpu MHz");
if (!pos)
return -1;
pos = strchr(pos, ':');
if (!pos)
return -1;
end = (pos += 2);
while (isdigit(*end)) ++end;
*end = '\0';
/* Return the Mhz part, and give it a +1. */
return atoi(pos)+1;
}
PJ_DEF(pj_status_t) pj_get_timestamp(pj_timestamp *ts)
{
if (machine_speed_mhz == 0) {
machine_speed_mhz = get_machine_speed_mhz();
if (machine_speed_mhz > 0) {
machine_speed.u64 = machine_speed_mhz * 1000000.0;
}
}
if (machine_speed_mhz == -1) {
ts->u64 = 0;
return -1;
}
ts->u64 = rdtsc();
return 0;
}
PJ_DEF(pj_status_t) pj_get_timestamp_freq(pj_timestamp *freq)
{
if (machine_speed_mhz == 0) {
machine_speed_mhz = get_machine_speed_mhz();
if (machine_speed_mhz > 0) {
machine_speed.u64 = machine_speed_mhz * 1000000.0;
}
}
if (machine_speed_mhz == -1) {
freq->u64 = 1; /* return 1 to prevent division by zero in apps. */
return -1;
}
freq->u64 = machine_speed.u64;
return 0;
}
#else
#include <sys/time.h>
#include <errno.h>
#define USEC_PER_SEC 1000000
PJ_DEF(pj_status_t) pj_get_timestamp(pj_timestamp *ts)
{
struct timeval tv;
if (gettimeofday(&tv, NULL) != 0) {
return PJ_RETURN_OS_ERROR(pj_get_native_os_error());
}
ts->u64 = tv.tv_sec;
ts->u64 *= USEC_PER_SEC;
ts->u64 += tv.tv_usec;
return PJ_SUCCESS;
}
PJ_DEF(pj_status_t) pj_get_timestamp_freq(pj_timestamp *freq)
{
freq->u32.hi = 0;
freq->u32.lo = USEC_PER_SEC;
return PJ_SUCCESS;
}
#endif
|
