Implementing the new interpolation similar to matlab, working partially, but there is a size problem