updatePoseEstimate

Updates the robot's pose estimate using the localizer.

This method should be called periodically (typically in the main loop) to update the robot's position and velocity estimates. It also maintains a history of recent poses for visualization and debugging.