修改根据新的物料格式,修改可视化

This commit is contained in:
zhangshixiang
2025-12-10 15:10:53 +08:00
parent 896f287d92
commit 8ba911bb55
2 changed files with 16 additions and 9 deletions

View File

@@ -203,9 +203,9 @@ class ResourceMeshManager(BaseROS2DeviceNode):
continue
# 提取位置信息并转换单位
position = {
"x": float(resource_config['position']['position']['x'])/1000,
"y": float(resource_config['position']['position']['y'])/1000,
"z": float(resource_config['position']['position']['z'])/1000
"x": float(resource_config['pose']['position']['x'])/1000,
"y": float(resource_config['pose']['position']['y'])/1000,
"z": float(resource_config['pose']['position']['z'])/1000
}
rotation_dict = {
@@ -214,8 +214,8 @@ class ResourceMeshManager(BaseROS2DeviceNode):
"z": 0
}
if 'rotation' in resource_config['position']:
rotation_dict = resource_config['position']['rotation']
if 'rotation' in resource_config['pose']:
rotation_dict = resource_config['pose']['rotation']
# 从欧拉角转换为四元数
q = quaternion_from_euler(