Skip to content
Snippets Groups Projects
Commit 1feea971 authored by KingMaZito's avatar KingMaZito
Browse files

...

parent 103319bf
Branches
No related tags found
No related merge requests found
......@@ -911,22 +911,22 @@ void Moveit_mediator::task_planner(){
}
}
for(auto& t : th){
t.join();
}
for(auto& exec : executions_){
for (int i = 0; i < robots_.size(); i++){
if (exec.first == robots_[i]->name()){
auto mr = dynamic_cast<Moveit_robot*>(robots_[i]);
manipulate_acm(mr, exec.second.second);
merge_ps(ps_m, exec.second.second, mr);
}
}
}
// for(auto& t : th){
// t.join();
// }
// for(auto& exec : executions_){
// for (int i = 0; i < robots_.size(); i++){
// if (exec.first == robots_[i]->name()){
// auto mr = dynamic_cast<Moveit_robot*>(robots_[i]);
// manipulate_acm(mr, exec.second.second);
// merge_ps(ps_m, exec.second.second, mr);
// }
// }
// }
merge_acm(ps_m);
planning_scene_diff_publisher_->publish(ps_m);
// merge_acm(ps_m);
// planning_scene_diff_publisher_->publish(ps_m);
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment