Trajectory Planning for Monocular SLAM based Exploration System

Sarthak Upadhyay    Ayush Dewan    Arun Kumar Singh    Madhava Krishna   

IIIT Hyderabad, India   


In this paper, we propose a novel planning technique for monocular camera based Simultaneous Localization and Mapping(VSLAM). In VSLAM, the objective is to estimate the trajectory of camera and simultaneously identify 3D feature points and build a map, using camera as a depth sensor. Unlike a laser range finder based SLAM, VSLAM is known to be erroneous when camera motion includes an in-place rotation or feature displacement is large for successive frames. We propose a motion planning framework which combines motion primitives based planning and trajectory optimization approach to generate trajectories which exactly connects an initial and final state and also ensures that the change in camera’s field of view between subsequent instances is less than some specified threshold. As a consequence of this motion planning framework we are able to automate SLAM and generate automated monocular SLAM maps of an indoor lab area. We also show when the robot follows the path of a generic planner, PTAM trajectory breaks more often than when it executes the path computed by the proposed planner. This performance improvement is further utilised to develop an autonomous vision based exploration system