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());
 }