// Public methods void GlobalPlanner::send_next_step(){ get_map_data(); populate_all_nodes(); get_destination(); get_current_location(); calculate_path(); find_next_step(); }
int main(int argc, char **argv) { ROS_INFO("start listening\n"); ros::init(argc, argv, "listener"); ros::NodeHandle n; ros::Subscriber sub_pos = n.subscribe("PoseChannel", 1000, Callback_position); ros::Subscriber sub_data = n.subscribe("sensorData", 1000, Callback_data); ///read the map and parse it (saved in map_arr[][]) get_map_data(); pub_location_pcl = n.advertise<PointCloud> ("location_point", 1000); location->header.frame_id = "location"; location->height = 1; // 1 for unorganized map location->width = 2; location->points.push_back (pcl::PointXYZRGB(255,0,0)); location->points.push_back (pcl::PointXYZRGB(0,255,0)); ros::spin(); localize.close(); //clear memory /* for (int i = 0; i < t; ++j) delete[] map_arr[i]; delete[] map_arr; */ return 0; }