Merge "Correcting Speed and Bearing Uncertainty Doc"