15 .robot_description(file_path=
"config/panda.urdf.xacro")
21 "moveit_servo_test": ParameterBuilder(
"moveit_servo")
22 .yaml(
"config/test_config_panda.yaml")
27 acceleration_filter_update_period = {
"update_period": 0.01}
28 planning_group_name = {
"planning_group_name":
"panda_arm"}
31 ros2_controllers_path = os.path.join(
32 get_package_share_directory(
"moveit_resources_panda_moveit_config"),
34 "ros2_controllers.yaml",
36 ros2_control_node = launch_ros.actions.Node(
37 package=
"controller_manager",
38 executable=
"ros2_control_node",
39 parameters=[ros2_controllers_path],
41 (
"/controller_manager/robot_description",
"/robot_description"),
46 joint_state_broadcaster_spawner = launch_ros.actions.Node(
47 package=
"controller_manager",
50 "joint_state_broadcaster",
51 "--controller-manager-timeout",
53 "--controller-manager",
54 "/controller_manager",
56 ros2_controllers_path,
60 panda_arm_controller_spawner = launch_ros.actions.Node(
61 package=
"controller_manager",
64 "panda_arm_controller",
66 "/controller_manager",
68 ros2_controllers_path,
73 test_container = launch_ros.actions.ComposableNodeContainer(
74 name=
"servo_integration_tests_container",
76 package=
"rclcpp_components",
77 executable=
"component_container_mt",
78 composable_node_descriptions=[
79 launch_ros.descriptions.ComposableNode(
80 package=
"robot_state_publisher",
81 plugin=
"robot_state_publisher::RobotStatePublisher",
82 name=
"robot_state_publisher",
83 parameters=[moveit_config.robot_description],
85 launch_ros.descriptions.ComposableNode(
87 plugin=
"tf2_ros::StaticTransformBroadcasterNode",
88 name=
"static_tf2_broadcaster",
89 parameters=[{
"child_frame_id":
"/panda_link0",
"frame_id":
"/world"}],
95 servo_gtest = launch_ros.actions.Node(
96 executable=launch.substitutions.PathJoinSubstitution(
98 launch.substitutions.LaunchConfiguration(
"test_binary_dir"),
99 "moveit_servo_cpp_integration_test",
104 acceleration_filter_update_period,
106 moveit_config.robot_description,
107 moveit_config.robot_description_semantic,
108 moveit_config.robot_description_kinematics,
113 return launch.LaunchDescription(
115 launch.actions.DeclareLaunchArgument(
116 name=
"test_binary_dir",
117 description=
"Binary directory of package "
118 "containing test executables",
121 joint_state_broadcaster_spawner,
122 panda_arm_controller_spawner,
126 launch.actions.RegisterEventHandler(
128 target_action=panda_arm_controller_spawner,
129 on_exit=[servo_gtest],
132 launch_testing.actions.ReadyToTest(),
135 "servo_gtest": servo_gtest,
test_gtest_pass(self, proc_info, servo_gtest)