utl_timer.h

/*
 * Developer : Alexey Zakharov (alexey.zakharov@vectioneer.com)
 * All rights reserved. Copyright (c) 2015 VECTIONEER.
 */
 
#ifndef UTILS_UTL_TIMER_H
#define UTILS_UTL_TIMER_H
 
#include <cstdint>
#include <ctime>
 
namespace mcx {
 
namespace utils {
 
static constexpr uint64_t NSEC = 1000000000;
static constexpr uint64_t MSEC = 1000000;
static constexpr uint64_t NSEC_MILISEC = 1000000;
static constexpr uint64_t NSEC_MSEC = 1000;
 
struct Timespec64 {
  int64_t tv_sec;  /* Seconds.  */
  int64_t tv_nsec; /* Nanoseconds.  */
};
 
constexpr Timespec64 timespecToTimespec64(const struct timespec& t) {
  return {.tv_sec = t.tv_sec, .tv_nsec = t.tv_nsec};
}
 
template <typename TIMESPEC>
constexpr uint64_t timespecToNanoS(const TIMESPEC& time) {
  return static_cast<uint64_t>(time.tv_sec) * NSEC + static_cast<uint64_t>(time.tv_nsec);
}
 
template <typename TIMESPEC>
constexpr uint64_t timespecToMicroS(const TIMESPEC& time) {
  return timespecToNanoS(time) / NSEC_MSEC;
}
 
template <typename TIMESPEC>
constexpr uint64_t timespecToMilliS(const TIMESPEC& time) {
  return timespecToNanoS(time) / NSEC_MILISEC;
}
 
template <typename TIMESPEC>
constexpr double timespecToS(const TIMESPEC& time) {
  return timespecToNanoS(time) / static_cast<double>(NSEC);
}
 
template <typename TIMESPEC>
constexpr timespec diff(const TIMESPEC& start, const TIMESPEC& end) {
  struct timespec temp {};
  if (end.tv_nsec < start.tv_nsec) {
    temp.tv_sec = end.tv_sec - start.tv_sec - 1;
    temp.tv_nsec = NSEC + end.tv_nsec - start.tv_nsec;
  } else {
    temp.tv_sec = end.tv_sec - start.tv_sec;
    temp.tv_nsec = end.tv_nsec - start.tv_nsec;
  }
  return temp;
}
 
template <typename TIMESPEC>
constexpr void correctNSec(TIMESPEC* time_n_sec) {
  while (static_cast<decltype(NSEC)>(time_n_sec->tv_nsec) >= NSEC) {
    time_n_sec->tv_nsec -= NSEC;
    time_n_sec->tv_sec++;
  }
}
 
template <typename TIMESPEC>
constexpr void incTime(TIMESPEC* time, const TIMESPEC& duration) {
  time->tv_sec += duration.tv_sec;
  time->tv_nsec += duration.tv_nsec;
  utils::correctNSec(time);
}
 
template <typename TIMESPEC>
constexpr void setTime(TIMESPEC* time, const TIMESPEC& value) {
  time->tv_sec = value.tv_sec;
  time->tv_nsec = value.tv_nsec;
  utils::correctNSec(time);
}
 
} // namespace utils
 
} // namespace mcx
 
#endif // UTILS_UTL_TIMER_H