Vector and matrix operations added.

Maybe also declare transformations functions, that directly return a 4x4
matrix, so you don't have to expand it after calling one of the other
functions.