Added mat3 header and implementation