mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-03 16:28:53 +08:00
TranslationControl: remove throttle
This commit is contained in:
committed by
Beat Küng
parent
6a4e3bb94e
commit
b0b72e63e7
@@ -238,9 +238,6 @@ void TranslationControl::_velocityController(const float &dt)
|
||||
bool stop_I[2] = {false, false}; // stop integration for xy and z
|
||||
ControlMath::constrainPIDu(_thr_sp, stop_I, _ThrLimit, direction);
|
||||
|
||||
/* Throttle is just thrust length. */
|
||||
_throttle = _thr_sp.length();
|
||||
|
||||
/* Update integrals */
|
||||
if (!stop_I[0]) {
|
||||
_thr_int(0) += vel_err(0) * Iv(0) * dt;
|
||||
|
||||
@@ -73,7 +73,6 @@ public:
|
||||
matrix::Vector3f getThrustSetpoint() {return _thr_sp;}
|
||||
float getYawSetpoint() { return _yaw_sp;}
|
||||
float getYawspeedSetpoint() {return _yawspeed_sp;}
|
||||
float getThrottle() {return _throttle;}
|
||||
matrix::Vector3f getVelSp() {return _vel_sp;}
|
||||
matrix::Vector3f getPosSp() {return _pos_sp;}
|
||||
|
||||
@@ -95,7 +94,6 @@ private:
|
||||
matrix::Vector3f _thr_sp{};
|
||||
float _yaw_sp{};
|
||||
float _yawspeed_sp{};
|
||||
float _throttle{};
|
||||
|
||||
/* Other variables */
|
||||
matrix::Vector3f _thr_int{};
|
||||
|
||||
Reference in New Issue
Block a user