AC_AttitudeControl: Limit _pos_target.z to below alt_max before computing error