45 #include <mathlib/mathlib.h> 85 float dt = (float)dt_micros * 1e-6
f;
90 if (dt_micros > 500000) {
91 lock_integrator =
true;
96 if (!lock_integrator &&
_k_i > 0.0
f) {
constexpr _Tp constrain(_Tp val, _Tp min_val, _Tp max_val)
Definition of geo / math functions to perform geodesic calculations.
Definition of a simple orthogonal pitch PID controller.
#define ecl_absolute_time()
#define ecl_elapsed_time(t)
Vector< float, 6 > f(float t, const Matrix< float, 6, 1 > &, const Matrix< float, 3, 1 > &)
float control_attitude(const struct ECL_ControlData &ctl_data) override
constexpr _Tp min(_Tp a, _Tp b)
constexpr _Tp max(_Tp a, _Tp b)
float control_euler_rate(const struct ECL_ControlData &ctl_data) override
float control_bodyrate(const struct ECL_ControlData &ctl_data) override
void set_bodyrate_setpoint(float rate)