- Added goStraight method
- Created the azimuthStart integer
- TODO: Print azimuth less often