smooth function

added smooth.m for smoothing RRT path