fsfw/src/fsfw/osal/linux/Clock.cpp

#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;
}