Make use of core::IdentityMatrix. Removed some redundant or unused code. Some minor reorganizations.

git-svn-id: svn://svn.code.sf.net/p/irrlicht/code/trunk@1079 dfc29bdd-3216-0410-991c-e03cc46cb475