Hi, i am working on sensor fusion fo imu and gps to have accurate position on world coordinates.
I have worked on 2D implementation in C++ but now i am facing it difficult to extend it to 3D as the parameters are really complex to add as i am getting confused how to make my state space and other matrix for predict and update, Plus fusing the data is also an issue how to introduce the data in the filter for 3D, I need to fuse (X Y Z) position of IMU also yaw, roll with (Longitude and Latitude [X Y]) position of GPS.
If anyone of you have implemented it or have leads to that where i can look or take any guide that would be a big help.
Thanks!
What I have tried:
i have worked with 1d and 2d kalman implementation for linear systems.