Rotation Matrix Fix

Fixed a bug in the rotationmatrix_normalized function.  q parameters were switched.