// Constructor
WaypointLoaderNode::WaypointLoaderNode() : private_nh_("~")
{
  initParameter();
  initPublisher();
}
OwnershipDataPublisher::OwnershipDataPublisher(string pub, DDS::Long strength)
{
  initPublisher(pub, strength);
}