Ported matrix4.d interface.
Ported matrix4.d, fixed errors with DEGTORAD/RADTODEG, ported some helpful math