fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-22 20:53:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

GotoControl: rename yaw rate acceleration parameter

Browse Source 
such that not only one letter differs to MPC_YAWRAUTO_MAX
This commit is contained in:
Matthias Grob
2023-11-30 17:16:02 +01:00
parent dc7f9165d1
commit d1e8bdbd16
3 changed files with 7 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_pos_control/GotoControl/GotoControl.cpp
+3 -3
View File
@@ -229,7 +229,7 @@ void GotoControl::setPositionSmootherLimits(const goto_setpoint_s &goto_setpoint
void GotoControl::setHeadingSmootherLimits(const goto_setpoint_s &goto_setpoint)
{
float max_heading_rate = _param_mpc_yawrauto_max.get();
float max_heading_accel = _param_mpc_yawaauto_max.get();
float max_heading_accel = _param_mpc_yawrauto_acc.get();
if (goto_setpoint.flag_set_max_heading_rate && PX4_ISFINITE(_param_mpc_yawrauto_max.get())) {
max_heading_rate = math::constrain(_param_mpc_yawrauto_max.get(), 0.f,
@@ -239,8 +239,8 @@ void GotoControl::setHeadingSmootherLimits(const goto_setpoint_s &goto_setpoint)
// only limit acceleration once within velocity constraints
if (fabsf(_heading_smoothing.getSmoothedHeadingRate()) <= max_heading_rate) {
const float rate_scale = max_heading_rate / _param_mpc_yawrauto_max.get();
max_heading_accel = math::constrain(_param_mpc_yawaauto_max.get() * rate_scale,
0.f, _param_mpc_yawaauto_max.get());
max_heading_accel = math::constrain(_param_mpc_yawrauto_acc.get() * rate_scale,
0.f, _param_mpc_yawrauto_acc.get());
}
}
src/modules/mc_pos_control/GotoControl/GotoControl.hpp
+1 -1
View File
@@ -132,7 +132,7 @@ private:
(ParamFloat<px4::params::MPC_ACC_UP_MAX>) _param_mpc_acc_up_max,
(ParamFloat<px4::params::MPC_JERK_AUTO>) _param_mpc_jerk_auto,
(ParamFloat<px4::params::MPC_YAWRAUTO_MAX>) _param_mpc_yawrauto_max,
(ParamFloat<px4::params::MPC_YAWAAUTO_MAX>) _param_mpc_yawaauto_max,
(ParamFloat<px4::params::MPC_YAWRAUTO_ACC>) _param_mpc_yawrauto_acc,
(ParamFloat<px4::params::MPC_XY_ERR_MAX>) _param_mpc_xy_err_max
);
};