81 lines
2.7 KiB
C++
81 lines
2.7 KiB
C++
#include "fsfw/timemanager/Clock.h"
|
|
|
|
#include <chrono>
|
|
|
|
#include "fsfw/ipc/MutexGuard.h"
|
|
#include "fsfw/platform.h"
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
#if defined(PLATFORM_WIN)
|
|
#include <sysinfoapi.h>
|
|
#define timegm _mkgmtime
|
|
#elif defined(PLATFORM_UNIX)
|
|
#include <fstream>
|
|
#endif
|
|
|
|
using SystemClock = std::chrono::system_clock;
|
|
|
|
ReturnValue_t Clock::setClock(const timeval* time) {
|
|
/* I don't know why someone would need to set a clock which is probably perfectly fine on a
|
|
host system with internet access so this is not implemented for now. */
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::warning << "Clock::setClock: Not implemented for host OSAL" << std::endl;
|
|
#else
|
|
sif::printWarning("Clock::setClock: Not implemented for host OSAL\n");
|
|
#endif
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
ReturnValue_t Clock::getClock_timeval(timeval* time) {
|
|
#if defined(PLATFORM_WIN)
|
|
auto now = std::chrono::system_clock::now();
|
|
auto secondsChrono = std::chrono::time_point_cast<std::chrono::seconds>(now);
|
|
auto epoch = now.time_since_epoch();
|
|
time->tv_sec = std::chrono::duration_cast<std::chrono::seconds>(epoch).count();
|
|
auto fraction = now - secondsChrono;
|
|
time->tv_usec = std::chrono::duration_cast<std::chrono::microseconds>(fraction).count();
|
|
return returnvalue::OK;
|
|
#elif defined(PLATFORM_UNIX)
|
|
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;
|
|
#else
|
|
#warning Clock::getClock_timeval() not implemented for your platform
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::warning << "Clock::getUptime: Not implemented for found OS!" << std::endl;
|
|
#else
|
|
sif::printWarning("Clock::getUptime: Not implemented for found OS!\n");
|
|
#endif
|
|
return returnvalue::FAILED;
|
|
#endif
|
|
}
|
|
|
|
timeval Clock::getUptime() {
|
|
timeval timeval;
|
|
#if defined(PLATFORM_WIN)
|
|
auto uptime = std::chrono::milliseconds(GetTickCount64());
|
|
auto secondsChrono = std::chrono::duration_cast<std::chrono::seconds>(uptime);
|
|
timeval.tv_sec = secondsChrono.count();
|
|
auto fraction = uptime - secondsChrono;
|
|
timeval.tv_usec = std::chrono::duration_cast<std::chrono::microseconds>(fraction).count();
|
|
#elif defined(PLATFORM_UNIX)
|
|
double uptimeSeconds;
|
|
if (std::ifstream("/proc/uptime", std::ios::in) >> uptimeSeconds) {
|
|
// value is rounded down automatically
|
|
timeval.tv_sec = uptimeSeconds;
|
|
timeval.tv_usec = uptimeSeconds * (double)1e6 - (timeval.tv_sec * 1e6);
|
|
}
|
|
#else
|
|
#warning Clock::getUptime() not implemented for your platform
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::warning << "Clock::getUptime: Not implemented for found OS" << std::endl;
|
|
#endif
|
|
#endif
|
|
return timeval;
|
|
}
|