mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 16:43:33 +08:00
VTOL: remove pusher reverse feature
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
@@ -348,10 +348,9 @@ MissionBlock::is_mission_item_reached_or_completed()
|
||||
_navigator->get_local_position()->vy * _navigator->get_local_position()->vy);
|
||||
|
||||
const float back_trans_dec = _navigator->get_vtol_back_trans_deceleration();
|
||||
const float reverse_delay = _navigator->get_vtol_reverse_delay();
|
||||
|
||||
if (back_trans_dec > FLT_EPSILON && velocity > FLT_EPSILON) {
|
||||
acceptance_radius = ((velocity / back_trans_dec / 2) * velocity) + reverse_delay * velocity;
|
||||
acceptance_radius = (velocity / back_trans_dec / 2) * velocity;
|
||||
|
||||
}
|
||||
|
||||
|
||||
@@ -314,7 +314,6 @@ public:
|
||||
float get_lndmc_alt_max() const { return _param_lndmc_alt_max.get(); }
|
||||
|
||||
float get_vtol_back_trans_deceleration() const { return _param_back_trans_dec_mss; }
|
||||
float get_vtol_reverse_delay() const { return _param_reverse_delay; }
|
||||
|
||||
bool force_vtol();
|
||||
|
||||
@@ -401,12 +400,10 @@ private:
|
||||
NavigatorMode *_navigation_mode_array[NAVIGATOR_MODE_ARRAY_SIZE] {}; /**< array of navigation modes */
|
||||
|
||||
param_t _handle_back_trans_dec_mss{PARAM_INVALID};
|
||||
param_t _handle_reverse_delay{PARAM_INVALID};
|
||||
param_t _handle_mpc_jerk_auto{PARAM_INVALID};
|
||||
param_t _handle_mpc_acc_hor{PARAM_INVALID};
|
||||
|
||||
float _param_back_trans_dec_mss{0.f};
|
||||
float _param_reverse_delay{0.f};
|
||||
float _param_mpc_jerk_auto{4.f}; /**< initialized with the default jerk auto value to prevent division by 0 if the parameter is accidentally set to 0 */
|
||||
float _param_mpc_acc_hor{3.f}; /**< initialized with the default horizontal acc value to prevent division by 0 if the parameter is accidentally set to 0 */
|
||||
|
||||
|
||||
@@ -96,7 +96,6 @@ Navigator::Navigator() :
|
||||
}
|
||||
|
||||
_handle_back_trans_dec_mss = param_find("VT_B_DEC_MSS");
|
||||
_handle_reverse_delay = param_find("VT_B_REV_DEL");
|
||||
|
||||
_handle_mpc_jerk_auto = param_find("MPC_JERK_AUTO");
|
||||
_handle_mpc_acc_hor = param_find("MPC_ACC_HOR");
|
||||
@@ -127,10 +126,6 @@ void Navigator::params_update()
|
||||
param_get(_handle_back_trans_dec_mss, &_param_back_trans_dec_mss);
|
||||
}
|
||||
|
||||
if (_handle_reverse_delay != PARAM_INVALID) {
|
||||
param_get(_handle_reverse_delay, &_param_reverse_delay);
|
||||
}
|
||||
|
||||
if (_handle_mpc_jerk_auto != PARAM_INVALID) {
|
||||
param_get(_handle_mpc_jerk_auto, &_param_mpc_jerk_auto);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user