It looks pretty awesome. For the fusion you could use the robot_localization package.
Here you have the link for the API. The point of this algorithm is that it can fuses a NavSatFix message and a IMU message (also odometry message can be used).
1 Like