Re-did useless vector class.
Added printAsserts
Matrix4 fully unittested