Made matrices, updated vectors, fixed include paths
Started quaternion base