Added matrix/functions

Added raw rotation matrix
Added methods: rotationAxis/rotationAngle/rotationMatrix
Fixed bug with frame history