See previous push Per Olav Flaten
 - Changed Rotation Matrix from 3x3 to 4x4