FM3 Flight controller test code