Use a 3D motion model in state estimation node
Description
After implementing the new EKF it should be easier to change the motion model in the state estimation node. For now it is not estimating a 3D pose. This issue is tracking the change to use it.
Definition of Done
-
The state estimation node estimates the 3D position of the system.
Edited by Igor Bogoslavskyi