Skip to content

Commit 6a01550

Browse files
committed
ComputeIK: update RobotState before calling setFromIK()
This became necessary due to moveit/moveit#3388.
1 parent 4d2a571 commit 6a01550

File tree

1 file changed

+3
-1
lines changed

1 file changed

+3
-1
lines changed

core/src/stages/compute_ik.cpp

Lines changed: 3 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -388,8 +388,10 @@ void ComputeIK::compute() {
388388
double remaining_time = timeout();
389389
auto start_time = std::chrono::steady_clock::now();
390390
while (ik_solutions.size() < max_ik_solutions && remaining_time > 0) {
391-
if (tried_current_state_as_seed)
391+
if (tried_current_state_as_seed) {
392392
sandbox_state.setToRandomPositions(jmg);
393+
sandbox_state.update();
394+
}
393395
tried_current_state_as_seed = true;
394396

395397
size_t previous = ik_solutions.size();

0 commit comments

Comments
 (0)