3 #ifndef HAVE_CLOCK_GETTIME
4 inline int clock_gettime(clockid_t clk_id, struct timespec *ts) {
6 if(unlikely(gettimeofday(&tv, NULL) == -1))
8 ts->tv_sec = tv.tv_sec;
9 ts->tv_nsec = (tv.tv_usec % USEC_PER_SEC) * NSEC_PER_USEC;
14 static inline time_t now_sec(clockid_t clk_id) {
16 if(unlikely(clock_gettime(clk_id, &ts) == -1))
21 static inline usec_t now_usec(clockid_t clk_id) {
23 if(unlikely(clock_gettime(clk_id, &ts) == -1))
25 return (usec_t)ts.tv_sec * USEC_PER_SEC + (ts.tv_nsec % NSEC_PER_SEC) / NSEC_PER_USEC;
28 static inline int now_timeval(clockid_t clk_id, struct timeval *tv) {
30 if(unlikely(clock_gettime(clk_id, &ts) == -1))
32 tv->tv_sec = ts.tv_sec;
33 tv->tv_usec = (suseconds_t)((ts.tv_nsec % NSEC_PER_SEC) / NSEC_PER_USEC);
37 inline time_t now_realtime_sec(void) {
38 return now_sec(CLOCK_REALTIME);
41 inline usec_t now_realtime_usec(void) {
42 return now_usec(CLOCK_REALTIME);
45 inline int now_realtime_timeval(struct timeval *tv) {
46 return now_timeval(CLOCK_REALTIME, tv);
49 inline time_t now_monotonic_sec(void) {
50 return now_sec(CLOCK_MONOTONIC);
53 inline usec_t now_monotonic_usec(void) {
54 return now_usec(CLOCK_MONOTONIC);
57 inline int now_monotonic_timeval(struct timeval *tv) {
58 return now_timeval(CLOCK_MONOTONIC, tv);
61 inline time_t now_boottime_sec(void) {
62 return now_sec(CLOCK_BOOTTIME);
65 inline usec_t now_boottime_usec(void) {
66 return now_usec(CLOCK_BOOTTIME);
69 inline int now_boottime_timeval(struct timeval *tv) {
70 return now_timeval(CLOCK_BOOTTIME, tv);
73 inline usec_t timeval_usec(struct timeval *tv) {
74 return (usec_t)tv->tv_sec * USEC_PER_SEC + (tv->tv_usec % USEC_PER_SEC);
77 inline msec_t timeval_msec(struct timeval *tv) {
78 return (msec_t)tv->tv_sec * MSEC_PER_SEC + ((tv->tv_usec % USEC_PER_SEC) / MSEC_PER_SEC);
81 inline susec_t dt_usec_signed(struct timeval *now, struct timeval *old) {
82 usec_t ts1 = timeval_usec(now);
83 usec_t ts2 = timeval_usec(old);
85 if(likely(ts1 >= ts2)) return (susec_t)(ts1 - ts2);
86 return -((susec_t)(ts2 - ts1));
89 inline usec_t dt_usec(struct timeval *now, struct timeval *old) {
90 usec_t ts1 = timeval_usec(now);
91 usec_t ts2 = timeval_usec(old);
92 return (ts1 > ts2) ? (ts1 - ts2) : (ts2 - ts1);
95 inline void heartbeat_init(heartbeat_t *hb)
100 usec_t heartbeat_next(heartbeat_t *hb, usec_t tick)
102 heartbeat_t now = now_monotonic_usec();
103 usec_t next = now - (now % tick) + tick;
106 sleep_usec(next - now);
107 now = now_monotonic_usec();
110 if(likely(*hb != 0ULL)) {
111 usec_t dt = now - *hb;
113 if(unlikely(dt / tick > 1))
114 error("heartbeat missed between %llu usec and %llu usec", *hb, now);
123 inline usec_t heartbeat_dt_usec(heartbeat_t *hb)
127 return now_monotonic_usec() - *hb;