A method of registering sets of anatomical data for use during a surgical procedure is provided herein. The method may include segmenting a set of first modality image data representing a model of one or more passageways within a patient and generating a first set of points based on the segmented set of first modality image data representing the model of the one or more passageways. The method may further include determining a set of matches between a second set of points and the first set of points, wherein the second set of points is obtained by a second modality and discarding a subset of the set of matches based on a first heuristic to generate a modified set of matches. The second set of points may then be moved relative to the first set of points based on the modified set of matches.