Fixed bug in rotationmatrix_normalized function.  (q parameters were switched)
Fixed bug in rotationmatrix_normalized function (q parameters were switched).
Merge pull request #3 from Cody-G/master

Rotation Matrix Fix