46 lines
1.1 KiB
C++
46 lines
1.1 KiB
C++
#include "Timer.h"
|
|
#include "../../serviceinterface/ServiceInterfaceStream.h"
|
|
#include <errno.h>
|
|
|
|
|
|
Timer::Timer() {
|
|
sigevent sigEvent;
|
|
sigEvent.sigev_notify = SIGEV_NONE;
|
|
sigEvent.sigev_signo = 0;
|
|
sigEvent.sigev_value.sival_ptr = &timerId;
|
|
int status = timer_create(CLOCK_MONOTONIC, &sigEvent, &timerId);
|
|
if(status!=0){
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "Timer creation failed with: " << status <<
|
|
" errno: " << errno << std::endl;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
Timer::~Timer() {
|
|
timer_delete(timerId);
|
|
}
|
|
|
|
int Timer::setTimer(uint32_t intervalMs) {
|
|
itimerspec timer;
|
|
timer.it_value.tv_sec = intervalMs / 1000;
|
|
timer.it_value.tv_nsec = (intervalMs * 1000000) % (1000000000);
|
|
timer.it_interval.tv_sec = 0;
|
|
timer.it_interval.tv_nsec = 0;
|
|
return timer_settime(timerId, 0, &timer, NULL);
|
|
}
|
|
|
|
|
|
int Timer::getTimer(uint32_t* remainingTimeMs){
|
|
itimerspec timer;
|
|
timer.it_value.tv_sec = 0;
|
|
timer.it_value.tv_nsec = 0;
|
|
timer.it_interval.tv_sec = 0;
|
|
timer.it_interval.tv_nsec = 0;
|
|
int status = timer_gettime(timerId, &timer);
|
|
|
|
*remainingTimeMs = timer.it_value.tv_sec * 1000 + timer.it_value.tv_nsec / 1000000;
|
|
|
|
return status;
|
|
}
|