public void PublishWaypointUpdateMessage(UserpointInstruction msg)
{
Debug.Log("Published new userpoint instruction: " + msg.ToYAMLString());
ros.Publish(UserpointPublisher.GetMessageTopic(), msg);
}
public static string ToYAMLString(UserpointInstruction msg)
{
return(msg.ToYAMLString());
}