44 #include <mathlib/mathlib.h> 61 float dt = (float)dt_micros * 1e-6
f;
66 if (dt_micros > 500000) {
67 lock_integrator =
true;
71 float min_speed = 1.0f;
constexpr _Tp constrain(_Tp val, _Tp min_val, _Tp max_val)
Definition of geo / math functions to perform geodesic calculations.
#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)
Type wrap_pi(Type x)
Wrap value in range [-π, π)
Definition of a simple orthogonal coordinated turn yaw PID controller.
constexpr _Tp max(_Tp a, _Tp b)
float control_bodyrate(const struct ECL_ControlData &ctl_data) override