Robuta

https://www.mathworks.com/help/nav/ref/ekfslam.posehistory.html poseHistory - Retrieve corrected and predicted pose history - MATLAB This MATLAB function retrieves the corrected and predicted pose history up to the current pose. retrievecorrectedpredictedposehistory