3D trajectory denoising