fixed quaternion to rotation matrix
Merge pull request #6 from GlenKelley/master

Fixed quaternion to rotation matrix