A medical navigation system including a controller configured to: generate a three-dimensional (3D) volume based upon acquired image information of a region of interest (ROI), determine a reference path (RP) to an object-of-interest (OOI) situated within the ROI, the RP defining an on-road path (ONP) through at least one natural pathway of an organ subject to cyclical motion and an adjacent off-road path (ORP) through tissue of the organ leading to the OOI, and an exit point situated between the ONP and the ORP, query an SSD within the at least one natural pathway to obtain SSDI, determine a shape and a pose of one or more portions of the SSD in accordance with the SSDI, calculate an error between the RP and the determined shape and pose of the SSD, and/or determine when or where to exit a wall of the natural pathway and begin the ORP based upon the calculated error.
