mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-20 00:51:42 +00:00
e09293a15e
A lot of these are breaking changes. frc::Timer was replaced with the contents of frc2::Timer. The others were in-place argument changes or removing deprecated non-unit overloads.
92 lines
2.0 KiB
C++
92 lines
2.0 KiB
C++
// Copyright (c) FIRST and other WPILib contributors.
|
|
// Open Source Software; you can modify and/or share it under the terms of
|
|
// the WPILib BSD license file in the root directory of this project.
|
|
|
|
#include "frc/Timer.h"
|
|
|
|
#include <chrono>
|
|
#include <thread>
|
|
|
|
#include "frc/DriverStation.h"
|
|
#include "frc/RobotController.h"
|
|
|
|
namespace frc {
|
|
|
|
void Wait(units::second_t seconds) {
|
|
std::this_thread::sleep_for(
|
|
std::chrono::duration<double>(seconds.to<double>()));
|
|
}
|
|
|
|
units::second_t GetTime() {
|
|
using std::chrono::duration;
|
|
using std::chrono::duration_cast;
|
|
using std::chrono::system_clock;
|
|
|
|
return units::second_t(
|
|
duration_cast<duration<double>>(system_clock::now().time_since_epoch())
|
|
.count());
|
|
}
|
|
|
|
} // namespace frc
|
|
|
|
using namespace frc;
|
|
|
|
Timer::Timer() {
|
|
Reset();
|
|
}
|
|
|
|
units::second_t Timer::Get() const {
|
|
if (m_running) {
|
|
return (GetFPGATimestamp() - m_startTime) + m_accumulatedTime;
|
|
} else {
|
|
return m_accumulatedTime;
|
|
}
|
|
}
|
|
|
|
void Timer::Reset() {
|
|
m_accumulatedTime = 0_s;
|
|
m_startTime = GetFPGATimestamp();
|
|
}
|
|
|
|
void Timer::Start() {
|
|
if (!m_running) {
|
|
m_startTime = GetFPGATimestamp();
|
|
m_running = true;
|
|
}
|
|
}
|
|
|
|
void Timer::Stop() {
|
|
if (m_running) {
|
|
m_accumulatedTime = Get();
|
|
m_running = false;
|
|
}
|
|
}
|
|
|
|
bool Timer::HasElapsed(units::second_t period) const {
|
|
return Get() > period;
|
|
}
|
|
|
|
bool Timer::HasPeriodPassed(units::second_t period) {
|
|
return AdvanceIfElapsed(period);
|
|
}
|
|
|
|
bool Timer::AdvanceIfElapsed(units::second_t period) {
|
|
if (Get() > period) {
|
|
// Advance the start time by the period.
|
|
m_startTime += period;
|
|
// Don't set it to the current time... we want to avoid drift.
|
|
return true;
|
|
} else {
|
|
return false;
|
|
}
|
|
}
|
|
|
|
units::second_t Timer::GetFPGATimestamp() {
|
|
// FPGA returns the timestamp in microseconds
|
|
return units::second_t(frc::RobotController::GetFPGATime() * 1.0e-6);
|
|
}
|
|
|
|
units::second_t Timer::GetMatchTime() {
|
|
return units::second_t(frc::DriverStation::GetInstance().GetMatchTime());
|
|
}
|