Gravar-mail: Filtered pose graph for efficient kinect pose reconstruction