Added auto distance and heading makrs
added driving and heading calculations
Finished? one ball auton