yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 09:22:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

FlightTaskManualAltitude: add deadzone for yaw

Browse Source
This commit is contained in:
Dennis Mannhart
2017-12-22 17:53:00 +01:00
committed by Beat Küng
parent cd1e01d5a0
commit ec4089cebf
2 changed files with 6 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/lib/FlightTasks/tasks/FlightTaskManualAltitude.cpp
View File

@@ -34,7 +34,7 @@
/**
* @file FlightTaskManual.hpp
*
* Flight task for manual controlled altitude.
* Flight-task for manual controlled altitude.
*
*/
@@ -51,7 +51,9 @@ FlightTaskManualAltitude::FlightTaskManualAltitude(control::SuperBlock *parent,
_vel_max_up(parent, "MPC_Z_VEL_MAX_UP", false),
_yaw_rate_scaling(parent, "MPC_MAN_Y_MAX", false),
_acc_max_up(parent, "MPC_ACC_UP_MAX", false),
_acc_max_down(parent, "MPC_ACC_DOWN_MAX", false)
_acc_max_down(parent, "MPC_ACC_DOWN_MAX", false),
_stick_deadzone(parent, "MPC_HOLD_DZ", false)
{}
bool FlightTaskManualAltitude::activate()
@@ -76,7 +78,7 @@ void FlightTaskManualAltitude::scaleSticks()
void FlightTaskManualAltitude::updateHeadingSetpoints()
{
if (fabsf(_sticks(3)) < FLT_EPSILON) {
if (fabsf(_sticks(3)) < _stick_deadzone.get()) {
/* Want to hold yaw */
_yaw_rate_sp = NAN;
_yaw_sp = _yaw_sp_predicted;