A medical system includes a medical instrument (102) configured for interventional deployment and a shape sensing system (104) mounted on or in the medical instrument and configured to measure a shape of the medical instrument during the interventional deployment. An imaging device (106) is mounted on or in the medical instrument and configured to image a lumen in which the imaging device is deployed. A registration module (140) is configured to register the shape of the medical instrument to an image of the lumen at a particular time to reconstruct a three-dimensional geometry of the lumen, accounting for motion.
