Fix up position interpolation

TODO: Fix removeOldPositions