allwpilib
allwpilib copied to clipboard
AngleStatistics should be able to handle multiple angular state variables
Currently only one angle index is passed in, but there are cases where multiple angular state variables may be desired (ex robot heading and turret heading).
Planning on doing this unless someone else is already on it.
Go ahead. Are you planning to add an overload that takes an array of indices?
Yep, that's what I was thinking