private string GetDataLine(string elapsedTime, SIGVerse.RosBridge.human_navigation.HumanNaviAvatarStatus avatarStatus, string dataType)
{
string dataLine = elapsedTime + "," + dataType;
dataLine += "\t" + "HumanNaviAvatarPose";
dataLine += "\t" + "head[position:" + avatarStatus.head.position.ToString() + ", orientation:" + avatarStatus.head.orientation.ToString() + "]";
dataLine += "\t" + "body[position:" + avatarStatus.body.position.ToString() + ", orientation:" + avatarStatus.body.orientation.ToString() + "]";
dataLine += "\t" + "left_hand[position:" + avatarStatus.left_hand.position.ToString() + ", orientation:" + avatarStatus.left_hand.orientation.ToString() + "]";
dataLine += "\t" + "right_hand[position:" + avatarStatus.right_hand.position.ToString() + ", orientation:" + avatarStatus.right_hand.orientation.ToString() + "]";
dataLine += "\t" + "object_in_left_hand:" + avatarStatus.object_in_left_hand;
dataLine += "\t" + "object_in_right_hand:" + avatarStatus.object_in_right_hand;
dataLine += "\t" + "is_target_object_in_left_hand:" + avatarStatus.is_target_object_in_left_hand.ToString();
dataLine += "\t" + "is_target_object_in_right_hand:" + avatarStatus.is_target_object_in_right_hand.ToString();
return(dataLine);
}
public void OnSendRosAvatarStatusMessage(SIGVerse.RosBridge.human_navigation.HumanNaviAvatarStatus avatarStatus)
{
base.AddDataLine(GetDataLine(this.GetHeaderElapsedTime(), avatarStatus, HumanNaviPlaybackCommon.DataTypeHumanNaviROSMessageSent));
}
