A 6-DOF UR5 arm executing an informative trajectory from our planner, that prioritize IMU bias convergence for increased localization accuracy.

The top left shows the executed 3D trajectory. The top right shows the extracted point features used in estimation and the bottom left shows a plot of how the localization error of our proposed adaptive trace method compares  to a joint optimization trace method as more trajectory segments are added in the experiment.