Matrix4 / Vector4 fixes

Fix issues brought up in tests. Comments as well.