Hello, I just read this paper: https://www.robotic.dlr.de/fileadmin/robotic/stroblk/publications/strobl_2006iros.pdf Which seems to be quite promising. Do you have an implementation of this?