More vector unit tests

Appears a normalized vec4 doesn't result in a vector of length one!
More work on matrices

probably relying to much on initializer lists but ill worry about
efficiency later.