void BaseWaypointCallback(const waypoint_follower::laneConstPtr &msg)
{
ROS_INFO("subscribed base_waypoint\n");
_path_dk.setPath(*msg);
_path_change.setPath(*msg);
if (_path_flag == false) {
std::cout << "waypoint subscribed" << std::endl;
_path_flag = true;
}
}
static void WayPointCallback(const waypoint_follower::laneConstPtr &msg)
{
_current_waypoints.setPath(*msg);
_waypoint_set = true;
//ROS_INFO_STREAM("waypoint subscribed");
}