Wait for start button pressed to begin, and improvements to path tracking