Add sensor quaternions and use for xsens.
Fix xsens GPS observations.
Merge pull request #96 from jabjoe/xsens_quat

Xsens quat