|
|
@ -285,7 +285,6 @@ void NavEKF2_core::FuseOptFlow() |
|
|
|
Vector3f relVelSensor; |
|
|
|
Vector3f relVelSensor; |
|
|
|
Vector14 SH_LOS; |
|
|
|
Vector14 SH_LOS; |
|
|
|
Vector2 losPred; |
|
|
|
Vector2 losPred; |
|
|
|
Vector28 Kfusion {}; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Copy required states to local variable names
|
|
|
|
// Copy required states to local variable names
|
|
|
|
float q0 = stateStruct.quat[0]; |
|
|
|
float q0 = stateStruct.quat[0]; |
|
|
|