Added Zeroing::offset_ready() helper and TODO.
Change-Id: I1bd1d0e667bb9081896f6f48030b8fcfb95cdc79
diff --git a/frc971/zeroing/zeroing_test.cc b/frc971/zeroing/zeroing_test.cc
index b4c9813..1134259 100644
--- a/frc971/zeroing/zeroing_test.cc
+++ b/frc971/zeroing/zeroing_test.cc
@@ -158,6 +158,13 @@
MoveTo(&sim, &estimator, 3.5 * index_diff);
}
ASSERT_NEAR(0.5, estimator.offset_ratio_ready(), 0.001);
+ ASSERT_FALSE(estimator.offset_ready());
+
+ for (unsigned int i = 0; i < kSampleSize / 2; i++) {
+ MoveTo(&sim, &estimator, 3.5 * index_diff);
+ }
+ ASSERT_NEAR(1.0, estimator.offset_ratio_ready(), 0.001);
+ ASSERT_TRUE(estimator.offset_ready());
}
TEST_F(ZeroingTest, TestOffset) {