smoothTrajectory function

Apply a moving average filter to the trajectory and create a smoothed trajectory