Esempio n. 1
0
// Public methods
void GlobalPlanner::send_next_step(){
	get_map_data();
	populate_all_nodes();
	get_destination();
	get_current_location();
	calculate_path();
	find_next_step();
}
Esempio n. 2
0
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;
}