An Enhanced Positioning Algorithm for a Self-Referencing Hand-Held 3D Sensor