feat(arcor2_ur): extend ros_worker for collision primitives and basic tests#891
feat(arcor2_ur): extend ros_worker for collision primitives and basic tests#891SimonKadnar wants to merge 8 commits intorobofit:masterfrom
Conversation
|
@SimonKadnar U těchto balíčků bude potřeba aktualizovat verzi, bohužel to nelze pinnout nějak rozumně. |
|
@codex review |
There was a problem hiding this comment.
💡 Codex Review
Here are some automated review suggestions for this pull request.
Reviewed commit: 70cae31176
ℹ️ About Codex in GitHub
Your team has set up Codex to review pull requests in this repo. Reviews are triggered when you
- Open a pull request for review
- Mark a draft as ready
- Comment "@codex review".
If Codex has suggestions, it will comment; otherwise it will react with 👍.
Codex can also answer questions or update the PR. Try commenting "@codex address that feedback".
| for cid in collision_ids(): | ||
| delete_collision_id(cid) |
There was a problem hiding this comment.
Iterate graspable IDs when deleting all graspables
delete_all_graspable() currently iterates collision_ids() and calls delete_collision_id(), so invoking it removes collisions but leaves graspables behind. Any cleanup path that relies on this helper will retain stale graspable objects and can pollute later planning/state checks; it should iterate graspable_ids() and call delete_graspable_id() instead.
Useful? React with 👍 / 👎.
|
@codex review |
There was a problem hiding this comment.
💡 Codex Review
Here are some automated review suggestions for this pull request.
Reviewed commit: 4e7e7af678
ℹ️ About Codex in GitHub
Your team has set up Codex to review pull requests in this repo. Reviews are triggered when you
- Open a pull request for review
- Mark a draft as ready
- Comment "@codex review".
If Codex has suggestions, it will comment; otherwise it will react with 👍.
Codex can also answer questions or update the PR. Try commenting "@codex address that feedback".
|
@codex review |
| <origin rpy="1.5707963267948966 0 0" xyz="0 0 -0.127"/> | ||
| <geometry> | ||
| <mesh filename="package://meshes/ur5e/collision/wrist1.stl"/> | ||
| <mesh filename="file:///mnt/c/Users/Office/Desktop/diplomka/kod/arcor2-ur5e/src/python/arcor2_ur/data/urdf/meshes/ur5e/collision/wrist1.stl"/> |
There was a problem hiding this comment.
💡 Codex Review
Here are some automated review suggestions for this pull request.
Reviewed commit: fc03ad54e5
ℹ️ About Codex in GitHub
Your team has set up Codex to review pull requests in this repo. Reviews are triggered when you
- Open a pull request for review
- Mark a draft as ready
- Comment "@codex review".
If Codex has suggestions, it will comment; otherwise it will react with 👍.
Codex can also answer questions or update the PR. Try commenting "@codex address that feedback".
| <origin rpy="0 0 3.141592653589793" xyz="0 0 0"/> | ||
| <geometry> | ||
| <mesh filename="package://meshes/ur5e/visual/base.dae"/> | ||
| <mesh filename="file:///mnt/c/Users/Office/Desktop/diplomka/kod/arcor2-ur5e/src/python/arcor2_ur/data/urdf/meshes/ur5e/visual/base.dae"/> |
There was a problem hiding this comment.
Restore portable mesh URIs in UR5e URDF
The URDF now hard-codes mesh filenames to a developer-specific Windows path (file:///mnt/c/Users/Office/...), so any environment that does not have that exact path (CI, containers, other developers, production hosts) cannot resolve robot meshes. This makes URDF consumers fail to load collision/visual geometry and breaks robot simulation/planning outside the author’s machine; these entries should stay portable (e.g., package://... or repository-relative references).
Useful? React with 👍 / 👎.
|
|
||
|
|
||
| collision_objects: dict[str, CollisionObject] = {} | ||
| collision_objects: dict[str, CollisionSceneObject] = {} |
There was a problem hiding this comment.
Keep line-safe iteration compatible with new object type
This change switches collision_objects values to CollisionSceneObject, but put_line_safe still iterates them as tuple pairs (for obj_id, (model, pose) in collision_objects.items()), which now raises a TypeError once any collision object exists. In practice, /utils/line-safe becomes unusable after adding a collision object, because the endpoint can no longer unpack scene entries.
Useful? React with 👍 / 👎.
Extended arcor2_ur ros_worker to support collision primitives (Box / Cylinder / Sphere)
Added basic collision-aware planning tests for box/cylinder/sphere obstacles.
Ensures the planner detours around obstacles when the direct path is blocked.