Reformat per new coding guidelines.

Change-Id: Ib0e5d3a6fabe6db414d72b334ca7a7f33bc5726b
This commit is contained in:
Peter Johnson
2015-06-25 22:57:43 -07:00
parent f5a82be9e5
commit cee77a3228
26 changed files with 1296 additions and 1576 deletions

View File

@@ -1,3 +1,9 @@
/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2015. All Rights Reserved. */
/* Open Source Software - may be modified and shared by FRC teams. The code */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project. */
/*----------------------------------------------------------------------------*/
#include "timestamp.h"
#include <cassert>
@@ -10,82 +16,74 @@
#endif
// offset in microseconds
static unsigned long long
zerotime()
{
static unsigned long long zerotime() {
#ifdef _WIN32
FILETIME ft;
unsigned long long tmpres = 0;
// 100-nanosecond intervals since January 1, 1601 (UTC)
// which means 0.1 us
GetSystemTimeAsFileTime(&ft);
tmpres |= ft.dwHighDateTime;
tmpres <<= 32;
tmpres |= ft.dwLowDateTime;
// January 1st, 1970 - January 1st, 1601 UTC ~ 369 years
// or 116444736000000000 us
static const unsigned long long deltaepoch = 116444736000000000ull;
tmpres -= deltaepoch;
return tmpres;
FILETIME ft;
unsigned long long tmpres = 0;
// 100-nanosecond intervals since January 1, 1601 (UTC)
// which means 0.1 us
GetSystemTimeAsFileTime(&ft);
tmpres |= ft.dwHighDateTime;
tmpres <<= 32;
tmpres |= ft.dwLowDateTime;
// January 1st, 1970 - January 1st, 1601 UTC ~ 369 years
// or 116444736000000000 us
static const unsigned long long deltaepoch = 116444736000000000ull;
tmpres -= deltaepoch;
return tmpres;
#else
timespec ts;
timespec ts;
clock_gettime(CLOCK_REALTIME, &ts);
clock_gettime(CLOCK_REALTIME, &ts);
// in 100-ns intervals
return static_cast<unsigned long long>(ts.tv_sec) * 10000000ull +
static_cast<unsigned long long>(ts.tv_nsec) / 100u;
// in 100-ns intervals
return static_cast<unsigned long long>(ts.tv_sec) * 10000000ull +
static_cast<unsigned long long>(ts.tv_nsec) / 100u;
#endif
}
static unsigned long long
timestamp()
{
static unsigned long long timestamp() {
#ifdef _WIN32
LARGE_INTEGER li;
QueryPerformanceCounter(&li);
// there is an imprecision with the initial value,
// but what matters is that timestamps are monotonic and consistent
return static_cast<unsigned long long>(li.QuadPart);
LARGE_INTEGER li;
QueryPerformanceCounter(&li);
// there is an imprecision with the initial value,
// but what matters is that timestamps are monotonic and consistent
return static_cast<unsigned long long>(li.QuadPart);
#else
timespec ts;
timespec ts;
// cannot fail, parameters are correct and we checked earlier we can
// access the clock
clock_gettime(CLOCK_MONOTONIC, &ts);
// in ns
return static_cast<unsigned long long>(ts.tv_sec) * 1000000000ull +
static_cast<unsigned long long>(ts.tv_nsec);
// cannot fail, parameters are correct and we checked earlier we can
// access the clock
clock_gettime(CLOCK_MONOTONIC, &ts);
// in ns
return static_cast<unsigned long long>(ts.tv_sec) * 1000000000ull +
static_cast<unsigned long long>(ts.tv_nsec);
#endif
}
static unsigned long long
update_frequency()
{
static unsigned long long update_frequency() {
#ifdef _WIN32
LARGE_INTEGER li;
if (!QueryPerformanceFrequency(&li) || !li.QuadPart)
{
// log something
std::terminate();
}
return static_cast<unsigned long long>(li.QuadPart);
LARGE_INTEGER li;
if (!QueryPerformanceFrequency(&li) || !li.QuadPart) {
// log something
std::terminate();
}
return static_cast<unsigned long long>(li.QuadPart);
#else
timespec ts;
timespec ts;
if (clock_getres(CLOCK_MONOTONIC, &ts) < 0)
{
// log error
std::terminate();
}
if (clock_getres(CLOCK_MONOTONIC, &ts) < 0) {
// log error
std::terminate();
}
assert(!ts.tv_sec);
assert(!ts.tv_sec);
// this is the precision of the clock, we want the number of updates per
// second, which is 1 / ts.tv_nsec * 1,000,000,000
static const unsigned long long billion = 1000000000ull;
// this is the precision of the clock, we want the number of updates per
// second, which is 1 / ts.tv_nsec * 1,000,000,000
static const unsigned long long billion = 1000000000ull;
return billion / static_cast<unsigned long long>(ts.tv_nsec);
return billion / static_cast<unsigned long long>(ts.tv_nsec);
#endif
}
@@ -93,14 +91,12 @@ static const unsigned long long zerotime_val = zerotime();
static const unsigned long long offset_val = timestamp();
static const unsigned long long frequency_val = update_frequency();
unsigned long long
NT_Now()
{
assert(offset_val > 0u);
assert(frequency_val > 0u);
unsigned long long delta = timestamp() - offset_val;
// because the frequency is in update per seconds, we have to multiply the
// delta by 10,000,000
unsigned long long delta_in_us = delta * 10000000ull / frequency_val;
return delta_in_us + zerotime_val;
unsigned long long NT_Now() {
assert(offset_val > 0u);
assert(frequency_val > 0u);
unsigned long long delta = timestamp() - offset_val;
// because the frequency is in update per seconds, we have to multiply the
// delta by 10,000,000
unsigned long long delta_in_us = delta * 10000000ull / frequency_val;
return delta_in_us + zerotime_val;
}