Abstract. In this paper we present an algorithm to correct 3D reconstruction errors of 3D ultrasound catheter caused by ultrasound image thickness. We also provide a easy way to quickly measure ultrasound image plane's thickness. With our thickness correction 3D reconstruction, registration accuracy of navigation system using 3D ultrasound catheters can be greatly improved.