Interpolation

Added linear interpolation to slow down trajectory