Doctoral Consortium paper presented at IEEE ISMAR 2021