Extended vector and matrix functionality

+ added diag getter for matrix4f
+ added to_a converter for vector4f