#include <estimator.h>
Classes | |
struct | State |
Public Member Functions | |
Estimator (ROSflight &_rf) | |
void | init () |
void | reset_adaptive_bias () |
void | reset_state () |
void | run () |
void | set_attitude_correction (const turbomath::Quaternion &q) |
const State & | state () const |
Private Member Functions | |
void | run_LPF () |
Private Attributes | |
turbomath::Vector | accel_LPF_ |
bool | attitude_correction_next_run_ |
turbomath::Vector | bias_ |
const turbomath::Vector | g_ = {0.0f, 0.0f, -1.0f} |
turbomath::Vector | gyro_LPF_ |
uint64_t | last_acc_update_us_ |
uint64_t | last_time_ |
turbomath::Quaternion | q_correction_ |
ROSflight & | RF_ |
State | state_ |
turbomath::Vector | w1_ |
turbomath::Vector | w2_ |
turbomath::Vector | w_acc_ |
Definition at line 46 of file estimator.h.
rosflight_firmware::Estimator::Estimator | ( | ROSflight & | _rf | ) |
Definition at line 38 of file estimator.cpp.
void rosflight_firmware::Estimator::init | ( | ) |
Definition at line 92 of file estimator.cpp.
void rosflight_firmware::Estimator::reset_adaptive_bias | ( | ) |
Definition at line 85 of file estimator.cpp.
void rosflight_firmware::Estimator::reset_state | ( | ) |
Definition at line 42 of file estimator.cpp.
void rosflight_firmware::Estimator::run | ( | ) |
Definition at line 121 of file estimator.cpp.
|
private |
Definition at line 99 of file estimator.cpp.
void rosflight_firmware::Estimator::set_attitude_correction | ( | const turbomath::Quaternion & | q | ) |
Definition at line 115 of file estimator.cpp.
|
inline |
Definition at line 62 of file estimator.h.
|
private |
Definition at line 87 of file estimator.h.
|
private |
Definition at line 92 of file estimator.h.
|
private |
Definition at line 85 of file estimator.h.
|
private |
Definition at line 74 of file estimator.h.
|
private |
Definition at line 88 of file estimator.h.
|
private |
Definition at line 80 of file estimator.h.
|
private |
Definition at line 79 of file estimator.h.
|
private |
Definition at line 93 of file estimator.h.
|
private |
Definition at line 76 of file estimator.h.
|
private |
Definition at line 77 of file estimator.h.
|
private |
Definition at line 82 of file estimator.h.
|
private |
Definition at line 83 of file estimator.h.
|
private |
Definition at line 90 of file estimator.h.