mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 04:03:34 +08:00
ekf2: remove size in name of state vector and matrix types
Then the state vector size can be changes without having to update the name
This commit is contained in:
@@ -85,7 +85,7 @@ void Ekf::fuseDrag(const dragSample &drag_sample)
|
||||
_state.vel(2));
|
||||
const Vector3f rel_wind_body = _state.quat_nominal.rotateVectorInverse(rel_wind_earth);
|
||||
const float rel_wind_speed = rel_wind_body.norm();
|
||||
const Vector24f state_vector_prev = getStateAtFusionHorizonAsVector();
|
||||
const VectorState state_vector_prev = getStateAtFusionHorizonAsVector();
|
||||
|
||||
Vector2f bcoef_inv;
|
||||
|
||||
@@ -105,7 +105,7 @@ void Ekf::fuseDrag(const dragSample &drag_sample)
|
||||
bcoef_inv(1) = bcoef_inv(0);
|
||||
}
|
||||
|
||||
Vector24f Kfusion;
|
||||
VectorState Kfusion;
|
||||
|
||||
// perform sequential fusion of XY specific forces
|
||||
for (uint8_t axis_index = 0; axis_index < 2; axis_index++) {
|
||||
|
||||
Reference in New Issue
Block a user