Copy identityMatrix to avoid accidentally changing it
Merge pull request #1 from Oletus/master

Copy identityMatrix to avoid accidentally changing it