Added basic 4x4 matrix compatibility.
Working on more matrices and general math functions.