Use toRotationMatrix
Extract function
Cleanup