Clean up & Document auton pathing commands

[Evan Pratten]

I wrote them all in a rush to get a demo working. They now need documentation, and cleanup