private Vector3 GetPosition(GeometryPoseStamped message)
{
return(new Vector3(
message.pose.position.x,
message.pose.position.y,
message.pose.position.z));
}
private Quaternion GetRotation(GeometryPoseStamped message)
{
return(new Quaternion(
message.pose.orientation.x,
message.pose.orientation.y,
message.pose.orientation.z,
message.pose.orientation.w));
}
private void InitializeMessage()
{
message = new GeometryPoseStamped();
message.header = new StandardHeader();
message.pose = new GeometryPose();
message.pose.orientation = new GeometryQuaternion();
message.pose.orientation.w = 1;
message.header.frame_id = "map";
message.header.stamp = new StandardTime();
// RaiseMessageRelease(new MessageEventArgs(message));
}
private void InitializeMessage()
{
message = new GeometryPoseStamped();
message.header = new StandardHeader();
}