Added matrix class
Split rotation into EulerAngle and AngleAxis