|
|
|
@ -229,7 +229,7 @@ void Ekf::resetHorizontalPositionTo(const Vector2f &new_horz_pos)
@@ -229,7 +229,7 @@ void Ekf::resetHorizontalPositionTo(const Vector2f &new_horz_pos)
|
|
|
|
|
_state_reset_status.posNE_counter++; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void Ekf::resetVerticalPositionTo(const float &new_vert_pos) |
|
|
|
|
void Ekf::resetVerticalPositionTo(const float new_vert_pos) |
|
|
|
|
{ |
|
|
|
|
const float old_vert_pos = _state.pos(2); |
|
|
|
|
_state.pos(2) = new_vert_pos; |
|
|
|
|