A system for mapping a tissue surface includes a probe for mapping a tissue surface, a localization system to measure a location data point indicative of the probes location, a memory in which to store the location data point, a servo mechanism to move the probe along at least a portion of the tissue surface, a controller to move the probe to a plurality of locations and to record in the memory a plurality of location data points, and a contact-sensing processor to analyze the plurality of location data points and to identify a subset thereof on the tissue surface. A modeling processor generates a model of the tissue surface using the subset of location data points. The contact-sensing processor utilizes probe velocity, or a rate of change in the distance moved by the probe, to determine contact between the probe and the tissue surface.
