Worked on path smoothing