Log field pose during auton

[erickrause]

https://pathplanner.dev/pplib-custom-logging.html It would be great if we can log the robot location to help debug auton