Fixed profiled_subsystem bug caught in 2017.
The estimator was not being reset correctly. It was immediately
going into the initialized but not zeroed state when reset,
rather than waiting until enough samples had been accumulated.
Change-Id: Ic30a33257a8623f189ad57de007bbcb87a9341e8
diff --git a/frc971/control_loops/profiled_subsystem.h b/frc971/control_loops/profiled_subsystem.h
index 7dbd1a8..78a9a76 100644
--- a/frc971/control_loops/profiled_subsystem.h
+++ b/frc971/control_loops/profiled_subsystem.h
@@ -48,6 +48,7 @@
void Reset() {
zeroed_.fill(false);
+ initialized_ = false;
for (auto &estimator : estimators_) {
estimator.Reset();
}