|
|
|
@ -684,7 +684,7 @@ void ModeGuided::pos_control_run()
@@ -684,7 +684,7 @@ void ModeGuided::pos_control_run()
|
|
|
|
|
|
|
|
|
|
float pos_offset_z_buffer = 0.0; // Vertical buffer size in m
|
|
|
|
|
if (guided_pos_terrain_alt) { |
|
|
|
|
pos_offset_z_buffer = MIN(copter.wp_nav->get_terrain_margin() * 100.0, 0.5 * fabsf(guided_pos_target_cm.z)); |
|
|
|
|
pos_offset_z_buffer = MIN(copter.wp_nav->get_terrain_margin() * 100.0, 0.5 * fabsF(guided_pos_target_cm.z)); |
|
|
|
|
} |
|
|
|
|
pos_control->input_pos_xyz(guided_pos_target_cm, terr_offset, pos_offset_z_buffer); |
|
|
|
|
|
|
|
|
|