Catmull-Rom curve working

- TODO: Still need to interpolate the end points