|
|
|
@ -390,7 +390,7 @@ void AC_Avoid::adjust_velocity_z(float kP, float accel_cmss, float& climb_rate_c
@@ -390,7 +390,7 @@ void AC_Avoid::adjust_velocity_z(float kP, float accel_cmss, float& climb_rate_c
|
|
|
|
|
// get distance from proximity sensor
|
|
|
|
|
float proximity_alt_diff; |
|
|
|
|
AP_Proximity *proximity = AP::proximity(); |
|
|
|
|
if (proximity && _proximity_enabled && proximity->get_upward_distance(proximity_alt_diff)) { |
|
|
|
|
if (proximity && proximity_avoidance_enabled() && proximity->get_upward_distance(proximity_alt_diff)) { |
|
|
|
|
proximity_alt_diff -= _margin; |
|
|
|
|
if (!limit_alt || proximity_alt_diff < alt_diff) { |
|
|
|
|
alt_diff = proximity_alt_diff; |
|
|
|
|