#pragma once #include #include #include #include #include #include inline UInt64 clock_gettime_ns(clockid_t clock_type = CLOCK_MONOTONIC) { struct timespec ts; clock_gettime(clock_type, &ts); return UInt64(ts.tv_sec * 1000000000LL + ts.tv_nsec); } /// Sometimes monotonic clock may not be monotonic (due to bug in kernel?). /// It may cause some operations to fail with "Timeout exceeded: elapsed 18446744073.709553 seconds". /// Takes previously returned value and returns it again if time stepped back for some reason. inline UInt64 clock_gettime_ns_adjusted(UInt64 prev_time, clockid_t clock_type = CLOCK_MONOTONIC) { UInt64 current_time = clock_gettime_ns(clock_type); if (likely(prev_time <= current_time)) return current_time; /// Something probably went completely wrong if time stepped back for more than 1 second. assert(prev_time - current_time <= 1000000000ULL); return prev_time; } /** Differs from Poco::Stopwatch only by using 'clock_gettime' instead of 'gettimeofday', * returns nanoseconds instead of microseconds, and also by other minor differences. */ class Stopwatch { public: /** CLOCK_MONOTONIC works relatively efficient (~15 million calls/sec) and doesn't lead to syscall. * Pass CLOCK_MONOTONIC_COARSE, if you need better performance with acceptable cost of several milliseconds of inaccuracy. */ explicit Stopwatch(clockid_t clock_type_ = CLOCK_MONOTONIC) : clock_type(clock_type_) { start(); } void start() { start_ns = nanoseconds(); is_running = true; } void stop() { stop_ns = nanoseconds(); is_running = false; } void reset() { start_ns = 0; stop_ns = 0; is_running = false; } void restart() { start(); } UInt64 elapsed() const { return elapsedNanoseconds(); } UInt64 elapsedNanoseconds() const { return is_running ? nanoseconds() - start_ns : stop_ns - start_ns; } UInt64 elapsedMicroseconds() const { return elapsedNanoseconds() / 1000U; } UInt64 elapsedMilliseconds() const { return elapsedNanoseconds() / 1000000UL; } double elapsedSeconds() const { return static_cast(elapsedNanoseconds()) / 1000000000ULL; } private: UInt64 start_ns = 0; UInt64 stop_ns = 0; clockid_t clock_type; bool is_running = false; UInt64 nanoseconds() const { return clock_gettime_ns_adjusted(start_ns, clock_type); } }; using StopwatchUniquePtr = std::unique_ptr; class AtomicStopwatch { public: explicit AtomicStopwatch(clockid_t clock_type_ = CLOCK_MONOTONIC) : clock_type(clock_type_) { restart(); } void restart() { start_ns = nanoseconds(0); } UInt64 elapsed() const { UInt64 current_start_ns = start_ns; return nanoseconds(current_start_ns) - current_start_ns; } UInt64 elapsedMilliseconds() const { return elapsed() / 1000000UL; } double elapsedSeconds() const { return static_cast(elapsed()) / 1000000000ULL; } /** If specified amount of time has passed, then restarts timer and returns true. * Otherwise returns false. * This is done atomically. */ bool compareAndRestart(double seconds) { UInt64 threshold = static_cast(seconds * 1000000000.0); UInt64 current_start_ns = start_ns; UInt64 current_ns = nanoseconds(current_start_ns); while (true) { if (current_ns < current_start_ns + threshold) return false; if (start_ns.compare_exchange_weak(current_start_ns, current_ns)) return true; } } struct Lock { AtomicStopwatch * parent = nullptr; Lock() = default; explicit operator bool() const { return parent != nullptr; } explicit Lock(AtomicStopwatch * parent_) : parent(parent_) {} Lock(Lock &&) = default; ~Lock() { if (parent) parent->restart(); } }; /** If specified amount of time has passed and timer is not locked right now, then returns Lock object, * which locks timer and, on destruction, restarts timer and releases the lock. * Otherwise returns object, that is implicitly casting to false. * This is done atomically. * * Usage: * if (auto lock = timer.compareAndRestartDeferred(1)) * /// do some work, that must be done in one thread and not more frequently than each second. */ Lock compareAndRestartDeferred(double seconds) { UInt64 threshold = UInt64(seconds * 1000000000.0); UInt64 current_start_ns = start_ns; UInt64 current_ns = nanoseconds(current_start_ns); while (true) { if ((current_start_ns & 0x8000000000000000ULL)) return {}; if (current_ns < current_start_ns + threshold) return {}; if (start_ns.compare_exchange_weak(current_start_ns, current_ns | 0x8000000000000000ULL)) return Lock(this); } } private: std::atomic start_ns; std::atomic lock {false}; clockid_t clock_type; /// Most significant bit is a lock. When it is set, compareAndRestartDeferred method will return false. UInt64 nanoseconds(UInt64 prev_time) const { return clock_gettime_ns_adjusted(prev_time, clock_type) & 0x7FFFFFFFFFFFFFFFULL; } };