Testing with estop to indicate that crazyflie is too high