When failsafe/auto landing
- disarm when sonar alt < 5 for 1 seconds
- disarm when baro pid very low for 2 seconds
- descend quicker when near ground