private void UpdateValues()
{
GeometryPoint rosP = rawMessage.pose.pose.position;
GeometryQuaternion rosQ = rawMessage.pose.pose.orientation;
position = new Vector3(-rosP.y, rosP.z, rosP.x);
orientation = new Quaternion(-rosQ.x, rosQ.z, rosQ.y, rosQ.w);
}
public PeoplePerson()
{
name = "";
position = new GeometryPoint();
velocity = new GeometryPoint();
reliability = 0;
tagnames = new string[0];
tags = new string[0];
}
private GeometryPoint GetGeometryPoint(Vector3 position)
{
GeometryPoint geometryPoint = new GeometryPoint();
geometryPoint.x = position.x;
geometryPoint.y = position.y;
geometryPoint.z = position.z;
return(geometryPoint);
}
public PeoplePositionMeasurement()
{
header = new StandardHeader();
name = "";
object_id = "";
pos = new GeometryPoint();
reliability = 0;
covariance = new double[9];
initialization = 0;
}
private GeometryPoint GetGeometryPoint(Vector3 position)
{
GeometryPoint geometryPoint = new GeometryPoint {
x = position.x,
y = position.y,
z = position.z
};
return(geometryPoint);
}
public GeometryPose()
{
position = new GeometryPoint();
orientation = new GeometryQuaternion();
}