sladro
5f263e503d
- 在execute_three_stages中添加路径记录调用
- 为SimulationPlayer添加get_planned_path方法
- 改进回放时自动显示路径和任务点标记
- 修复回放时机械臂移动精度问题
🤖 Generated with Claude Code
Co-Authored-By: Claude <noreply@anthropic.com>
109 lines
1.6 KiB
JSON
109 lines
1.6 KiB
JSON
{
|
|
"robot": {
|
|
"model_path": "models/manual_robot.urdf",
|
|
"base_position": [
|
|
0.0,
|
|
1.6,
|
|
0.0
|
|
],
|
|
"base_orientation": [
|
|
0.0,
|
|
0.0,
|
|
1.5
|
|
]
|
|
},
|
|
"wall": {
|
|
"position": [
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
],
|
|
"dimensions": {
|
|
"width": 3.0,
|
|
"height": 2.5,
|
|
"thickness": 0.2
|
|
},
|
|
"material": {
|
|
"color": [
|
|
0.8,
|
|
0.8,
|
|
0.8,
|
|
1.0
|
|
],
|
|
"type": "concrete"
|
|
}
|
|
},
|
|
"hole": {
|
|
"position_relative_to_wall": [
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
],
|
|
"dimensions": {
|
|
"width": 2.0,
|
|
"height": 2.0
|
|
},
|
|
"shape": "rectangle"
|
|
},
|
|
"task_points": {
|
|
"point_A": {
|
|
"position": [
|
|
0.0,
|
|
0.5,
|
|
0.5
|
|
],
|
|
"description": "取物点，与机械臂同侧"
|
|
},
|
|
"point_B": {
|
|
"position": [
|
|
0.5,
|
|
-0.3,
|
|
0.3
|
|
],
|
|
"description": "目标点，墙体另一侧"
|
|
}
|
|
},
|
|
"transport_object": {
|
|
"initial_position": [
|
|
1.0,
|
|
0.5,
|
|
0.5
|
|
],
|
|
"dimensions": {
|
|
"width": 0.1,
|
|
"height": 0.1,
|
|
"depth": 0.1
|
|
},
|
|
"mass": 0.5,
|
|
"shape": "cube",
|
|
"material": {
|
|
"color": [
|
|
1.0,
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
],
|
|
"friction": 0.7
|
|
}
|
|
},
|
|
"simulation": {
|
|
"timestep": 0.01,
|
|
"gravity": [
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
],
|
|
"real_time": false
|
|
},
|
|
"path_planning": {
|
|
"collision": {
|
|
"check_resolution": 0.05,
|
|
"safety_margin": 0.05
|
|
},
|
|
"execution": {
|
|
"velocity_scaling": 1.0,
|
|
"position_tolerance": 0.02,
|
|
"motor_max_force": 150.0
|
|
}
|
|
}
|
|
} |