Added First cut at flight test with algorithms