Less old vecmath

Btw changed the naming convention of basic math templates