A Smoothing Algorithm for Minimum Sensing Path Plans in Gaussian Belief Space