Implemented general flight functionality, first successful tests