54 lines
1.2 KiB
C++
54 lines
1.2 KiB
C++
#ifndef _UNITREE_ARM_TIMER_H_
|
|
#define _UNITREE_ARM_TIMER_H_
|
|
|
|
#include <iostream>
|
|
#include <unistd.h>
|
|
#include <stdint.h>
|
|
#include <sys/time.h>
|
|
#include <sys/timerfd.h>
|
|
|
|
namespace UNITREE_ARM {
|
|
|
|
inline long long getSystemTime(){
|
|
struct timeval t;
|
|
gettimeofday(&t, NULL);
|
|
return 1000000 * t.tv_sec + t.tv_usec;
|
|
}
|
|
|
|
inline double getTimeSecond(){
|
|
double time = getSystemTime() * 0.000001;
|
|
return time;
|
|
}
|
|
|
|
inline void absoluteWait(long long startTime, long long waitTime){
|
|
if(getSystemTime() - startTime > waitTime){
|
|
std::cout << "[WARNING] The waitTime=" << waitTime << " of function absoluteWait is not enough!" << std::endl
|
|
<< "The program has already cost " << getSystemTime() - startTime << "us." << std::endl;
|
|
}
|
|
while(getSystemTime() - startTime < waitTime){
|
|
usleep(50);
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
waitTimeS = 0 means do not care time out
|
|
*/
|
|
class AbsoluteTimer{
|
|
public:
|
|
AbsoluteTimer(double waitTimeS);
|
|
~AbsoluteTimer();
|
|
void start();
|
|
bool wait();
|
|
private:
|
|
void _updateWaitTime(double waitTimeS);
|
|
int _timerFd;
|
|
uint64_t _missed;
|
|
double _waitTime;
|
|
double _startTime;
|
|
double _leftTime;
|
|
double _nextWaitTime;
|
|
itimerspec _timerSpec;
|
|
};
|
|
}
|
|
#endif |