|
|
|
@ -48,7 +48,7 @@ void Ekf::fuseDrag()
@@ -48,7 +48,7 @@ void Ekf::fuseDrag()
|
|
|
|
|
float H_ACC[24] = {}; // Observation Jacobian
|
|
|
|
|
float SK_ACC[9] = {}; // Variable used to optimise calculations of the Kalman gain vector
|
|
|
|
|
float Kfusion[24] = {}; // Kalman gain vector
|
|
|
|
|
float R_ACC = _params.drag_noise; // observation noise in specific force drag (m/sec**2)
|
|
|
|
|
float R_ACC = _params.drag_noise; // observation noise variance in specific force drag (m/sec**2)**2
|
|
|
|
|
|
|
|
|
|
float rho = fmaxf(_air_density, 0.1f); // air density (kg/m**3)
|
|
|
|
|
|
|
|
|
|