Collision detection implementation almost finished. Changed vector3.h to linearalgebra.h with some matrix functions.