full control working, attitude and small altitude tuned