Example #1
0
int main(int argc, char **argv)  
{
	ros::init(argc, argv, "setpoints_publisher");  
  
    ros::NodeHandle nh;  
  
    ros::Subscriber localposition_sub = nh.subscribe("/mavros/local_position/local", 500,chatterCallback_LocalPosition);
      
    set_new_point(2.0, 1.0, 3.0, 0.0, 2.0);
    set_new_point(5.0, 1.0, 3.0, 0.0, 1.0);


    return 0;

}
void invperc (const int size, const int nfill) {
	
	int i;
	for (i = 0; i < nfill; ++i){
		struct found_point point = percolate(size);
		if(set_new_point(size, point)) { break; }
	}
}