mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 00:44:37 -06:00
10f2b49d3f
* Use Fw::TimeInterval in LinuxTimer * Fix Linux FD typo * Fix interval timer UT * Format * Fix assert casts * Fix ComLogger UTs * Fix FppTest microseconds * Fix casting * Fix overflow
63 lines
2.0 KiB
C++
63 lines
2.0 KiB
C++
// ======================================================================
|
|
// \title LinuxTimerImpl.cpp
|
|
// \author tim
|
|
// \brief cpp file for LinuxTimer component implementation class
|
|
//
|
|
// \copyright
|
|
// Copyright 2009-2015, by the California Institute of Technology.
|
|
// ALL RIGHTS RESERVED. United States Government Sponsorship
|
|
// acknowledged.
|
|
//
|
|
// ======================================================================
|
|
|
|
#include <sys/timerfd.h>
|
|
#include <unistd.h>
|
|
#include <Fw/FPrimeBasicTypes.hpp>
|
|
#include <Fw/Logger/Logger.hpp>
|
|
#include <Svc/LinuxTimer/LinuxTimer.hpp>
|
|
#include <cerrno>
|
|
#include <cstring>
|
|
|
|
namespace Svc {
|
|
|
|
void LinuxTimer::startTimer(const Fw::TimeInterval& interval) {
|
|
int fd;
|
|
struct itimerspec itval;
|
|
|
|
/* Create the timer */
|
|
fd = timerfd_create(CLOCK_MONOTONIC, 0);
|
|
time_t seconds_value = static_cast<time_t>(interval.getSeconds());
|
|
// Ensure an overflow did not occur
|
|
FW_ASSERT(seconds_value == interval.getSeconds());
|
|
itval.it_interval.tv_sec = static_cast<time_t>(seconds_value);
|
|
itval.it_interval.tv_nsec = static_cast<long>(interval.getUSeconds() * 1000);
|
|
itval.it_value.tv_sec = static_cast<time_t>(seconds_value);
|
|
itval.it_value.tv_nsec = static_cast<long>(interval.getUSeconds() * 1000);
|
|
|
|
timerfd_settime(fd, 0, &itval, nullptr);
|
|
|
|
while (true) {
|
|
unsigned long long missed;
|
|
int ret = static_cast<int>(read(fd, &missed, sizeof(missed)));
|
|
if (-1 == ret) {
|
|
Fw::Logger::log("timer read error: %s\n", strerror(errno));
|
|
}
|
|
this->m_mutex.lock();
|
|
bool quit = this->m_quit;
|
|
this->m_mutex.unLock();
|
|
if (quit) {
|
|
itval.it_interval.tv_sec = 0;
|
|
itval.it_interval.tv_nsec = 0;
|
|
itval.it_value.tv_sec = 0;
|
|
itval.it_value.tv_nsec = 0;
|
|
|
|
timerfd_settime(fd, 0, &itval, nullptr);
|
|
return;
|
|
}
|
|
this->m_rawTime.now();
|
|
this->CycleOut_out(0, this->m_rawTime);
|
|
}
|
|
}
|
|
|
|
} // end namespace Svc
|