Sub-millimeter precision 3D measurement through a standard endoscope with time of flight