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

PositionControl: thrust setpoint check with fabsf

Browse Source
This commit is contained in:
Dennis Mannhart
2018-03-15 10:23:59 +01:00
committed by Beat Küng
parent 26ffda5079
commit 48fa3fbca3
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/mc_pos_control/PositionControl.cpp
View File

@@ -243,10 +243,10 @@ void PositionControl::_velocityController(const float &dt)
}
/* Satureate thrust setpoint in D-direction */
/* Saturate thrust setpoint in D-direction */
_thr_sp(2) = math::constrain(thrust_desired_D, uMin, uMax);
if (_thr_sp(0) + _thr_sp(1) > FLT_EPSILON) {
if (fabsf(_thr_sp(0)) + fabsf(_thr_sp(1)) > FLT_EPSILON) {
/* Thrust setpoints in NE-direction is already provided. Only
* scaling is required.