Started copying some code from other repos.

Most of this was used for 1-2d code, and will be changed
Interpolator passing tests