Run a square wp mission for testing cornering
Updates - added second WPNav controller
updates