Merge pull request #26 from florent-lamiraux/master

Check that quaternion is normalized when converting to rotation matrix