Stochastic Optimal Enhancement of Distributed Formation Control Using Kalman Smoothers