Smoothing added after planning