mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
avoid double state update before collision check (#2)
This commit is contained in:
parent
2dfc2f395e
commit
d02816ef67
@ -76,7 +76,7 @@ namespace {
|
||||
const double* joint_positions){
|
||||
state->setJointGroupPositions(jmg, joint_positions);
|
||||
state->update();
|
||||
return !scene->isStateColliding(*state, jmg->getName());
|
||||
return !scene->isStateColliding(static_cast<const robot_state::RobotState&>(*state), jmg->getName());
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
@ -100,7 +100,7 @@ namespace {
|
||||
|
||||
state->setJointGroupPositions(jmg, joint_positions);
|
||||
state->update();
|
||||
if( scene->isStateColliding(*state, jmg->getName()) ){
|
||||
if( scene->isStateColliding(static_cast<const robot_state::RobotState&>(*state), jmg->getName()) ){
|
||||
old_solutions->emplace_back();
|
||||
state->copyJointGroupPositions(jmg, old_solutions->back());
|
||||
return false;
|
||||
|
||||
Loading…
Reference in New Issue
Block a user