fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-21 19:47:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

FlightTaskManualStabilized: allow attitude control with 0 throttle

Browse Source 
With minimum throttle set to 0, it was not possible to control the attitude
anymore at 0 throttle, the vehicle would just stay level.
This commit is contained in:
Beat Küng
2018-09-22 09:12:50 +02:00
committed by Lorenz Meier
parent b93d02aee7
commit afada8ddb5
1 changed files with 2 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/FlightTasks/tasks/ManualStabilized/FlightTaskManualStabilized.cpp
+2 -1
View File
@@ -123,9 +123,10 @@ void FlightTaskManualStabilized::_updateThrustSetpoints()
/* The final thrust setpoint is found by rotating the scaled unit vector pointing
* upward by the Axis-Angle.
* Make sure that the attitude can be controlled even at 0 throttle.
*/
Quatf q_sp = AxisAnglef(v(0), v(1), 0.0f);
_thrust_setpoint = q_sp.conjugate(Vector3f(0.0f, 0.0f, -1.0f)) * _throttle;
_thrust_setpoint = q_sp.conjugate(Vector3f(0.0f, 0.0f, -1.0f)) * math::max(_throttle, 0.0001f);
}
void FlightTaskManualStabilized::_rotateIntoHeadingFrame(Vector2f &v)