void HandleCurrentWaypointMissionResponse(JSONNode response)
{
MissionWaypointTaskMsg waypoint_task = new MissionWaypointTaskMsg(response["values"]);
Debug.LogFormat("Current waypoint mission: \n{0}", waypoint_task.ToYAMLString());
}
public void UploadWaypointsTask(MissionWaypointTaskMsg task)
{
string service_name = "/dji_sdk/mission_waypoint_upload";
ros.CallService(HandleUploadWaypointsTaskResponse, service_name, string.Format("{0} {1}", client_id, service_name), args: string.Format("[{0}]", task.ToYAMLString()));
}