fixed matrix4 & did some cube.cpp stuff