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
@@ -19,13 +19,13 @@ from iiwa_msgs.action import MoveToPose, MoveToJoints
from iiwa_msgs.srv import MoveToNamedPose
# Таблица планировщиков: имя → (pipeline, planner_id, время планирования в секундах)
# Таблица планировщиков
PLANNERS = {
"ompl": ("ompl", "RRTConnectkConfigDefault", 10.0),
"ptp": ("pilz_industrial_motion_planner", "PTP", 2.0),
"lin": ("pilz_industrial_motion_planner", "LIN", 2.0),
"circ": ("pilz_industrial_motion_planner", "CIRC", 2.0),
"chomp": ("chomp", "", 10.0),
"ompl": ("ompl", "RRTConnectkConfigDefault", 10.0),
"ptp": ("pilz_industrial_motion_planner", "PTP", 2.0),
"lin": ("pilz_industrial_motion_planner", "LIN", 2.0),
"circ": ("pilz_industrial_motion_planner", "CIRC", 2.0),
"chomp": ("chomp", "", 10.0),
}