Use the new EKF implementation in state estimation node
Description
After !918 (merged) there is a new implementation for the Kalman Filter. This issue tracks transition towards using it in the state estimation node.
Definition of Done
-
state_estimation_node
uses the new implementation -
old Kalman filter code is removed
Edited by Igor Bogoslavskyi