Added function, revised delay, cleanup

Added function/command to automatically set some autopilot stuff at beginning of flight
Revised the delay between runs
Cleaned up a bit, added some comments