gc_math: Add an identity matrix