Implement interpolate for vectors

- Add templated vector interpolate function
- Add unit tests for vector interpolate
- Use interpolate in MassSpringRepresentationLocalization