Testing new math library

Seems to be working for initializing and constructing different sizes of
matrices and vectors.