|
|
|
@ -48,16 +48,19 @@
@@ -48,16 +48,19 @@
|
|
|
|
|
|
|
|
|
|
ECL_YawController::ECL_YawController() : |
|
|
|
|
_last_run(0), |
|
|
|
|
_tc(0.1f), |
|
|
|
|
_k_p(0.0f), |
|
|
|
|
_k_i(0.0f), |
|
|
|
|
_k_d(0.0f), |
|
|
|
|
_integrator_max(0.0f), |
|
|
|
|
_max_rate(0.0f), |
|
|
|
|
_roll_ff(0.0f), |
|
|
|
|
_last_output(0.0f), |
|
|
|
|
_integrator(0.0f), |
|
|
|
|
_rate_error(0.0f), |
|
|
|
|
_rate_setpoint(0.0f), |
|
|
|
|
_bodyrate_setpoint(0.0f), |
|
|
|
|
_coordinated(1.0f) |
|
|
|
|
|
|
|
|
|
_coordinated(0.0f) |
|
|
|
|
{ |
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float ECL_YawController::control_attitude(float roll, float pitch, |
|
|
|
|