Fix identity matrix

Forgot to update it after we switched from floating point to fixed point