IntervalTimer.cpp

Go to the documentation of this file.

 
#include <Os/IntervalTimer.hpp>
#include <Fw/Types/Assert.hpp>
#include <time.h>
#include <errno.h>
 
namespace Os {
    void IntervalTimer::getRawTime(RawTime& time) {
        timespec t;
 
        FW_ASSERT(clock_gettime(CLOCK_REALTIME,&t) == 0,errno);
        time.upper = t.tv_sec;
        time.lower = t.tv_nsec;
    }
 
    // Adapted from: http://www.gnu.org/software/libc/manual/html_node/Elapsed-Time.html
    // should be t1In - t2In
    U32 IntervalTimer::getDiffUsec(const RawTime& t1In, const RawTime& t2In) {
        RawTime result = {t1In.upper - t2In.upper, 0};
        if (t1In.lower < t2In.lower) {
            result.upper -= 1; // subtract nsec carry to seconds
            result.lower = t1In.lower + (1000000000 - t2In.lower);
        } else {
            result.lower = t1In.lower - t2In.lower;
        }
        return (result.upper * 1000000) + (result.lower / 1000);
    }
}