I have a quadcopter, and several components in play. First, I have a real position system (VICON), and I also have a SLAM platform. Then, of course, the IMU on the quadcoptor. I am trying to implement my control system which is heavily dependent on VICON to be dependent on the SLAM data instead.
My SLAM data is not as accurate as the VICON nor are its update as timely. (ie: VICON 100hz, SLAM 1hz on a Pi, 10hz on a laptop).
What I am trying to do is estimate my position using the on-board IMU data. Using an EKF, I would like to then use the SLAM data for the correction step. My hope is that somewhere between the two of these I can get a reasonable position to fly (and map with).
Where I am having some trouble is figuring out how to use the sensors to estimate some kind of position. My thinking is I will take that into my EKF for the estimation step.
Appreciate any insight into accomplishing this goal.