private GeometryQuaternion GetGeometryQuaternion(Quaternion quaternion)
{
GeometryQuaternion geometryQuaternion = new GeometryQuaternion();
geometryQuaternion.x = quaternion.x;
geometryQuaternion.y = quaternion.y;
geometryQuaternion.z = quaternion.z;
geometryQuaternion.w = quaternion.w;
return(geometryQuaternion);
}
public GeometryPose()
{
position = new GeometryPoint();
orientation = new GeometryQuaternion();
}