[wpimath] Fix pose estimator reset methods

[wpimath] Fix pose estimator reset methods #11998