EKF: Add multi-rotor drag model for wind estimation

This commit is contained in:
Paul Riseborough
2017-04-16 13:07:12 +02:00
committed by Lorenz Meier
parent b07acd8cf3
commit 465b145929
11 changed files with 377 additions and 6 deletions
+11
View File
@@ -510,6 +510,17 @@ void Ekf::get_flow_innov_var(float flow_innov_var[2])
memcpy(flow_innov_var, _flow_innov_var, sizeof(_flow_innov_var));
}
void Ekf::get_drag_innov(float drag_innov[2])
{
memcpy(drag_innov, _drag_innov, sizeof(_drag_innov));
}
void Ekf::get_drag_innov_var(float drag_innov_var[2])
{
memcpy(drag_innov_var, _drag_innov_var, sizeof(_drag_innov_var));
}
// calculate optical flow gyro bias errors
void Ekf::calcOptFlowBias()
{