I'm using the robot_localization package for fusing several data inputs. I have a theorical model that estimates an ideal odometry for my robot only based on my commands and the robot model. On the other hand, I have a SLAM estimation system as input for the EKF too.
My robot is a quadcopter and it has a yaw drift. I mean, its yaw value changes slowly over the time; and that is not registered by the theoretical model estimation. So model a slam orientation diverge very fast (in a minute or so). With enough time, there would be even 90º between their orientations, so it would be like one of them were not accomplishing the rep 103..
The question is: What would be the best way to fuse those estimations? Should I associate the "model yaw" to the estimated pose or is the EFK robust against orientation differences? Maybe I should do some reset of the theoretical pose estimated?
Thank you in advance, Juan.
Post score: 0