Reconstruction of 3D organ image using endoscope with Magneto-position-sensor