open_pub/Uni-Lab-OS
1
0
Fork 0
mirror of https://github.com/dptech-corp/Uni-Lab-OS.git synced 2025-12-18 13:31:20 +00:00
Code Issues Packages Projects Releases Wiki Activity

添加缺少物料："plate_well_G12",

Browse Source
This commit is contained in:
zhangshixiang
2025-06-08 00:45:25 +08:00
parent 4c1c8b1924
commit 07b7835a83
2 changed files with 18 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
test/experiments/plr_test_converted.json
View File

@@ -5756,7 +5756,8 @@
"plate_well_D12", "plate_well_D12",
"plate_well_E12", "plate_well_E12",
"plate_well_F12", "plate_well_F12",
"plate_well_G12" "plate_well_G12",
"plate_well_H12"
], ],
"parent": "deck", "parent": "deck",
"type": "plate", "type": "plate",

23
unilabos/ros/nodes/presets/resource_mesh_manager.py
View File

@@ -392,6 +392,8 @@ class ResourceMeshManager(BaseROS2DeviceNode):
planning_scene.is_diff = True planning_scene.is_diff = True
planning_scene.robot_state.is_diff = True planning_scene.robot_state.is_diff = True
time_start = self.get_clock().now() time_start = self.get_clock().now()
count = 0
for resource_id, target_parent in cmd_dict.items(): for resource_id, target_parent in cmd_dict.items():
parent_id = target_parent parent_id = target_parent
if target_parent == '__trash': if target_parent == '__trash':
@@ -453,15 +455,20 @@ class ResourceMeshManager(BaseROS2DeviceNode):
collision_object.link_name = target_parent collision_object.link_name = target_parent
planning_scene.robot_state.attached_collision_objects.append(collision_object) planning_scene.robot_state.attached_collision_objects.append(collision_object)
# collision_object = AttachedCollisionObject( count += 1
# link_name=target_parent,
# object=CollisionObject( if count > 30:
# id=resource_id, req = ApplyPlanningScene.Request()
# operation=CollisionObject.ADD req.scene = planning_scene
# ) self.publish_resource_tf()
# ) self._apply_planning_scene_service.call(req)
self.__planning_scene_publisher.publish(planning_scene)
count = 0
planning_scene = PlanningScene()
planning_scene.is_diff = True
planning_scene.robot_state.is_diff = True
# self.__planning_scene.robot_state.attached_collision_objects.append(collision_object)
req = ApplyPlanningScene.Request() req = ApplyPlanningScene.Request()
req.scene = planning_scene req.scene = planning_scene
self.publish_resource_tf() self.publish_resource_tf()