57 lines
1.4 KiB
C++
57 lines
1.4 KiB
C++
#include "fsfw/timemanager/Clock.h"
|
|
|
|
#include <linux/sysinfo.h>
|
|
#include <sys/sysinfo.h>
|
|
#include <unistd.h>
|
|
|
|
#include <ctime>
|
|
#include <fstream>
|
|
|
|
#include "fsfw/ipc/MutexGuard.h"
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
ReturnValue_t Clock::setClock(const timeval* time) {
|
|
timespec timeUnix{};
|
|
timeUnix.tv_sec = time->tv_sec;
|
|
timeUnix.tv_nsec = (__syscall_slong_t)time->tv_usec * 1000;
|
|
int status = clock_settime(CLOCK_REALTIME, &timeUnix);
|
|
if (status != 0) {
|
|
// TODO errno
|
|
return returnvalue::FAILED;
|
|
}
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
ReturnValue_t Clock::getClock_timeval(timeval* time) {
|
|
timespec timeUnix{};
|
|
int status = clock_gettime(CLOCK_REALTIME, &timeUnix);
|
|
if (status != 0) {
|
|
return returnvalue::FAILED;
|
|
}
|
|
time->tv_sec = timeUnix.tv_sec;
|
|
time->tv_usec = timeUnix.tv_nsec / 1000.0;
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
timeval Clock::getUptime() {
|
|
timeval uptime{0,0};
|
|
double uptimeSeconds;
|
|
if (std::ifstream("/proc/uptime", std::ios::in) >> uptimeSeconds) {
|
|
uptime->tv_sec = uptimeSeconds;
|
|
uptime->tv_usec = uptimeSeconds * (double)1e6 - (uptime->tv_sec * 1e6);
|
|
}
|
|
return uptime;
|
|
}
|
|
|
|
// Wait for new FSFW Clock function delivering seconds uptime.
|
|
// uint32_t Clock::getUptimeSeconds() {
|
|
// //TODO This is not posix compatible and delivers only seconds precision
|
|
// struct sysinfo sysInfo;
|
|
// int result = sysinfo(&sysInfo);
|
|
// if(result != 0){
|
|
// return returnvalue::FAILED;
|
|
// }
|
|
// return sysInfo.uptime;
|
|
//}
|
|
|