UKF Implementation

[TsingLoo]

I want to propose the consideration of implementing the Unscented Kalman Filter (UKF) instead of the current Extended Kalman Filter (EKF) for sensor fusion in the project.

I wonder, if it's possible to encapsulate the actual filter implementation by using abstract or interface-like calls in the update_imu and update_camera functions.