A fiber housing includes multiple shape sensing cores and a single optical core. A distal end of the fiber housing is positionable to direct the single optical core to a current point of an anatomical target. Collimated light over a first range of frequencies is projected from the single optical core to the current point. OFDR is used to detect reflected light scattered from the current point and to process the detected light to determine a distance to the current point. Light over a second range of frequencies is projected through the multiple shape sensing optical cores to the distal end of the fiber housing. OFDR is used to measure light reflected from the distal end of the fiber housing back through the multiple shape sensing optical cores and to process the measurement to determine a position in three dimensional space of the distal end of the fiber housing and a pointing direction of the distal end of the fiber housing. A position in three dimensional space of the current point is determined based on the determined position in three dimensional space of the distal end of the fiber housing, the pointing direction of the distal end of the fiber housing, and the determined distance.
