navigator: do not use fixed wing acceptance readius if in rotary wing mode

Signed-off-by: RomanBapst <bapstroman@gmail.com>
This commit is contained in:
RomanBapst
2019-12-06 14:34:33 +01:00
committed by Daniel Agar
parent 2e7221cd22
commit 4c35b3aadc
+3 -1
View File
@@ -862,7 +862,9 @@ Navigator::get_acceptance_radius(float mission_item_radius)
const position_controller_status_s &pos_ctrl_status = _position_controller_status_sub.get();
if ((pos_ctrl_status.timestamp > _pos_sp_triplet.timestamp) && pos_ctrl_status.acceptance_radius > radius) {
if (_vstatus.vehicle_type != vehicle_status_s::VEHICLE_TYPE_ROTARY_WING
&& (pos_ctrl_status.timestamp > _pos_sp_triplet.timestamp)
&& pos_ctrl_status.acceptance_radius > radius) {
radius = pos_ctrl_status.acceptance_radius;
}