Skip to content

Commit f62bfb0

Browse files
committed
Use _table_ids for collision bodies in BiRRT motion planning
Update _plan_with_simulator to check for _table_ids (list of int) first, falling back to the old _table (Object) pattern for compatibility.
1 parent 9857995 commit f62bfb0

1 file changed

Lines changed: 5 additions & 2 deletions

File tree

  • predicators/ground_truth_models/skill_factories

predicators/ground_truth_models/skill_factories/base.py

Lines changed: 5 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -544,8 +544,11 @@ def _plan_with_simulator(
544544
continue
545545
collision_bodies.add(sim_obj.id)
546546

547-
# 4b. Add the table if present.
548-
if hasattr(sim, '_table') and sim._table.id is not None:
547+
# 4b. Add tables if present.
548+
if hasattr(sim, '_table_ids'):
549+
for tid in sim._table_ids:
550+
collision_bodies.add(tid)
551+
elif hasattr(sim, '_table') and sim._table.id is not None:
549552
collision_bodies.add(sim._table.id)
550553

551554
# 4c. Add extra sim collision bodies (e.g. virtual buffer zones).

0 commit comments

Comments
 (0)