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

mpc: use xy stick limiting function from library

Browse Source
This commit is contained in:
bresch
2022-07-08 14:03:44 +02:00
committed by Mathieu Bresciani
parent 7e9a45a01a
commit 1de38c88d9
1 changed files with 1 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/flight_mode_manager/tasks/ManualPosition/FlightTaskManualPosition.cpp
+1 -5
View File
@@ -73,11 +73,7 @@ void FlightTaskManualPosition::_scaleSticks()
/* Constrain length of stick inputs to 1 for xy*/
Vector2f stick_xy = _sticks.getPositionExpo().slice<2, 1>(0, 0);
const float mag = math::constrain(stick_xy.length(), 0.0f, 1.0f);
if (mag > FLT_EPSILON) {
stick_xy = stick_xy.normalized() * mag;
}
Sticks::limitStickUnitLengthXY(stick_xy);
const float max_speed_from_estimator = _sub_vehicle_local_position.get().vxy_max;