Add single mag encoder zeroing method
This assumes the mag encoder doesn't move more than 1 revolution.
Change-Id: I932f4ea0e6457a4ac3430c35b7bfda7e6eb1b5c4
diff --git a/frc971/zeroing/wrap.h b/frc971/zeroing/wrap.h
index c6ec085..976e605 100644
--- a/frc971/zeroing/wrap.h
+++ b/frc971/zeroing/wrap.h
@@ -9,6 +9,13 @@
double Wrap(double nearest, double value, double period);
float Wrap(float nearest, float value, float period);
+inline double UnWrap(double nearest, double value, double period) {
+ return Wrap(nearest, value, period);
+}
+inline float UnWrap(float nearest, float value, float period) {
+ return Wrap(nearest, value, period);
+}
+
} // namespace zeroing
} // namespace frc971