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; } } }