Minimum altitude in auto

@sjwilks @julianoes @DrTon @thomasgubler This change enforce the minimum altitude in loiter if no mission is loaded. Please review carefully.

This is untested. @sjwilks A flight test would be cool, but test carefully.
Did you mean to say "If its current altitude is already higher than NAV_TAKEOFF_ALT..."?