fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Factor in reverse pusher delay on mission acceptance radius

Browse Source
This commit is contained in:
sanderux 2017-09-05 01:59:20 +02:00 committed by Sander Smeets
parent 5352cffe3f
commit 919b3a218a
2 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/modules/navigator/mission_block.cpp
View File

@ -65,7 +65,8 @@ MissionBlock::MissionBlock(Navigator *navigator, const char *name) :
_param_vtol_wv_takeoff(this, "VT_WV_TKO_EN", false),
_param_vtol_wv_loiter(this, "VT_WV_LTR_EN", false),
_param_force_vtol(this, "NAV_FORCE_VT", false),
_param_back_trans_dec_mss(this, "VT_B_DEC_MSS", false)
_param_back_trans_dec_mss(this, "VT_B_DEC_MSS", false),
_param_reverse_delay(this, "VT_B_REV_DEL", false)
{
}
@ -300,7 +301,9 @@ MissionBlock::is_mission_item_reached()
_navigator->get_local_position()->vy * _navigator->get_local_position()->vy);
if (_param_back_trans_dec_mss.get() > FLT_EPSILON && velocity > FLT_EPSILON) {
mission_acceptance_radius = (velocity / _param_back_trans_dec_mss.get() / 2) * velocity;
mission_acceptance_radius = ((velocity / _param_back_trans_dec_mss.get() / 2) * velocity) + _param_reverse_delay.get() *
velocity;
}
}

1
src/modules/navigator/mission_block.h
View File

@ -149,6 +149,7 @@ protected:
control::BlockParamInt _param_vtol_wv_loiter;
control::BlockParamInt _param_force_vtol;
control::BlockParamFloat _param_back_trans_dec_mss;
control::BlockParamFloat _param_reverse_delay;
};
#endif