Reorganised, added Flight Controller Test 1