forked from Archive/PX4-Autopilot
17 lines
434 B
C++
17 lines
434 B
C++
#include <sys/time.h>
|
|
#include <inttypes.h>
|
|
#include <drivers/drv_hrt.h>
|
|
#include <stdio.h>
|
|
|
|
hrt_abstime hrt_absolute_time() {
|
|
struct timeval te;
|
|
gettimeofday(&te, NULL); // get current time
|
|
hrt_abstime us = static_cast<uint64_t>(te.tv_sec) * 1e6 + te.tv_usec; // caculate us
|
|
return us;
|
|
}
|
|
|
|
hrt_abstime hrt_elapsed_time(const volatile hrt_abstime *then) {
|
|
// not thread safe
|
|
return hrt_absolute_time() - *then;
|
|
}
|