2018-12-01 00:05:33 -08:00
|
|
|
/*----------------------------------------------------------------------------*/
|
2020-09-27 13:27:53 -07:00
|
|
|
/* Copyright (c) 2018-2020 FIRST. All Rights Reserved. */
|
2018-12-01 00:05:33 -08:00
|
|
|
/* 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 "frc/Watchdog.h" // NOLINT(build/include_order)
|
|
|
|
|
|
|
|
|
|
#include <stdint.h>
|
|
|
|
|
|
|
|
|
|
#include <wpi/raw_ostream.h>
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
#include "frc/simulation/SimHooks.h"
|
2018-12-01 00:05:33 -08:00
|
|
|
#include "gtest/gtest.h"
|
|
|
|
|
|
|
|
|
|
using namespace frc;
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
namespace {
|
|
|
|
|
class WatchdogTest : public ::testing::Test {
|
|
|
|
|
protected:
|
|
|
|
|
void SetUp() override { frc::sim::PauseTiming(); }
|
|
|
|
|
|
|
|
|
|
void TearDown() override { frc::sim::ResumeTiming(); }
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
} // namespace
|
|
|
|
|
|
|
|
|
|
TEST_F(WatchdogTest, EnableDisable) {
|
2018-12-01 00:05:33 -08:00
|
|
|
uint32_t watchdogCounter = 0;
|
|
|
|
|
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog(0.4_s, [&] { watchdogCounter++; });
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
wpi::outs() << "Run 1\n";
|
|
|
|
|
watchdog.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter) << "Watchdog triggered early";
|
|
|
|
|
|
|
|
|
|
wpi::outs() << "Run 2\n";
|
|
|
|
|
watchdogCounter = 0;
|
|
|
|
|
watchdog.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.6_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(1u, watchdogCounter)
|
|
|
|
|
<< "Watchdog either didn't trigger or triggered more than once";
|
|
|
|
|
|
|
|
|
|
wpi::outs() << "Run 3\n";
|
|
|
|
|
watchdogCounter = 0;
|
|
|
|
|
watchdog.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(1_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(1u, watchdogCounter)
|
|
|
|
|
<< "Watchdog either didn't trigger or triggered more than once";
|
|
|
|
|
}
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
TEST_F(WatchdogTest, Reset) {
|
2018-12-01 00:05:33 -08:00
|
|
|
uint32_t watchdogCounter = 0;
|
|
|
|
|
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog(0.4_s, [&] { watchdogCounter++; });
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
watchdog.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Reset();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter) << "Watchdog triggered early";
|
|
|
|
|
}
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
TEST_F(WatchdogTest, SetTimeout) {
|
2018-12-01 00:05:33 -08:00
|
|
|
uint32_t watchdogCounter = 0;
|
|
|
|
|
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog(1.0_s, [&] { watchdogCounter++; });
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
watchdog.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2019-09-03 15:58:31 -07:00
|
|
|
watchdog.SetTimeout(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
EXPECT_EQ(0.2, watchdog.GetTimeout());
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter) << "Watchdog triggered early";
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.3_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(1u, watchdogCounter)
|
|
|
|
|
<< "Watchdog either didn't trigger or triggered more than once";
|
|
|
|
|
}
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
TEST_F(WatchdogTest, IsExpired) {
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog(0.2_s, [] {});
|
2019-02-02 00:22:07 -08:00
|
|
|
EXPECT_FALSE(watchdog.IsExpired());
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Enable();
|
|
|
|
|
|
|
|
|
|
EXPECT_FALSE(watchdog.IsExpired());
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.3_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
EXPECT_TRUE(watchdog.IsExpired());
|
2019-02-02 00:22:07 -08:00
|
|
|
|
|
|
|
|
watchdog.Disable();
|
|
|
|
|
EXPECT_TRUE(watchdog.IsExpired());
|
|
|
|
|
|
|
|
|
|
watchdog.Reset();
|
|
|
|
|
EXPECT_FALSE(watchdog.IsExpired());
|
2018-12-01 00:05:33 -08:00
|
|
|
}
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
TEST_F(WatchdogTest, Epochs) {
|
2018-12-01 00:05:33 -08:00
|
|
|
uint32_t watchdogCounter = 0;
|
|
|
|
|
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog(0.4_s, [&] { watchdogCounter++; });
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
wpi::outs() << "Run 1\n";
|
|
|
|
|
watchdog.Enable();
|
|
|
|
|
watchdog.AddEpoch("Epoch 1");
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.1_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.AddEpoch("Epoch 2");
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.1_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.AddEpoch("Epoch 3");
|
|
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter) << "Watchdog triggered early";
|
|
|
|
|
|
|
|
|
|
wpi::outs() << "Run 2\n";
|
|
|
|
|
watchdog.Enable();
|
|
|
|
|
watchdog.AddEpoch("Epoch 1");
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.Reset();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.2_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog.AddEpoch("Epoch 2");
|
|
|
|
|
watchdog.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter) << "Watchdog triggered early";
|
|
|
|
|
}
|
|
|
|
|
|
2020-09-27 13:27:53 -07:00
|
|
|
TEST_F(WatchdogTest, MultiWatchdog) {
|
2018-12-01 00:05:33 -08:00
|
|
|
uint32_t watchdogCounter1 = 0;
|
|
|
|
|
uint32_t watchdogCounter2 = 0;
|
|
|
|
|
|
2019-09-03 15:58:31 -07:00
|
|
|
Watchdog watchdog1(0.2_s, [&] { watchdogCounter1++; });
|
|
|
|
|
Watchdog watchdog2(0.6_s, [&] { watchdogCounter2++; });
|
2018-12-01 00:05:33 -08:00
|
|
|
|
|
|
|
|
watchdog2.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.25_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
EXPECT_EQ(0u, watchdogCounter1) << "Watchdog triggered early";
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter2) << "Watchdog triggered early";
|
|
|
|
|
|
|
|
|
|
// Sleep enough such that only the watchdog enabled later times out first
|
|
|
|
|
watchdog1.Enable();
|
2020-09-27 13:27:53 -07:00
|
|
|
frc::sim::StepTiming(0.25_s);
|
2018-12-01 00:05:33 -08:00
|
|
|
watchdog1.Disable();
|
|
|
|
|
watchdog2.Disable();
|
|
|
|
|
|
|
|
|
|
EXPECT_EQ(1u, watchdogCounter1)
|
|
|
|
|
<< "Watchdog either didn't trigger or triggered more than once";
|
|
|
|
|
EXPECT_EQ(0u, watchdogCounter2) << "Watchdog triggered early";
|
|
|
|
|
}
|