This commit is contained in:
JaeyoungLim
2022-10-26 16:40:54 +02:00
parent 51fc5a8c2f
commit d6201bb137
@@ -56,6 +56,7 @@ Vector3f DobControl::update(const Vector3f &rate,
const Vector3f actuator_sp, const float dt, const bool landed)
{
// angular rates error
///TODO: Use angular acceleration instead of differentiator
Vector3f diff = differentiator(rate, dt);
matrix::Vector3f integ_input = actuator_sp - diff;