A method is provided. The method includes: obtaining global position and orientation information of a first trajectory point; determining at least one pair of second trajectory points based on the global position and orientation information; obtaining a relative position and orientation estimation…