feat: enhance motion sequence capabilities and add configuration support

- Updated README.md to include examples for data collection and motion sequence testing.
- Modified setting.yaml to change the TCP link for planning from "patron" to "link_ee".
- Refactored move_to_pose_server.py to improve planner configuration readability.
- Updated setup.py to include motion_config.json in package resources and added a new console script for testing motion sequences.
- Introduced motion_config.json to define home joints and poses for motion sequences.
- Added test_motion_sequence.py to implement a test runner for executing motion sequences and recording data to a bag file.
This commit is contained in:
Даниил Грабарь
2026-05-06 14:03:41 +10:00
parent cd4dcf97ac
commit 9f30b9ff5d
6 changed files with 1168 additions and 9 deletions
+9 -1
View File
@@ -47,7 +47,7 @@ LC_ALL=C ros2 launch iiwa_moveit demo...
sudo pip3 install transforms3d --break-system-packages
```
Отправка робота в точку:
```
```bash
ros2 action send_goal /iiwa/move_to_pose iiwa_msgs/action/MoveToPose \
"{x: 0.5, y: 0.0, z: 0.5, a: 3.14, b: 0, c: 0, speed: 0.1, planner: 'ptp'}"
@@ -63,6 +63,14 @@ ros2 service call /iiwa/move_to_named iiwa_msgs/srv/MoveToNamedPose \
ros2 service call /iiwa/stop std_srvs/srv/Trigger "{}"
```
Пример сбора данных:
```bash
ros2 run iiwa_utils test_motion_sequence --ros-args -p n_iterations:=5 -p bag_path:=test_bag/ -p topics:="['/joint_states', '/d455_top/color/image_raw/image', '/d455_top/image_raw/camera_info']"
ros2 run iiwa_utils test_motion_sequence \
--ros-args -p config_path:=/path/to/my_config.json
```
Спавн объекта:
```bash
{