A system and method is provided for automatic navigation of medical tools. The system can include a tracking system operable to provide information relating to the position of at least a portion of a tool which is inside a body, and an automated navigation system operable to apply forces upon a portion of the tool. The automated navigation system can include a computer operable to store a 3-dimensional route. Furthermore, the automated navigation system can be operable to use the information relating to the position of at least the portion of the tool from the tracking system to apply calculated forces upon the tool, the calculated forces being associated with movement of the tool along the 3-dimensional route.