15 .robot_description(file_path=
"config/panda.urdf.xacro")
21 "moveit_servo_test": ParameterBuilder(
"moveit_servo")
22 .yaml(
"config/panda_simulated_config.yaml")
27 low_pass_filter_coeff = {
"butterworth_filter_coeff": 1.5}
30 ros2_controllers_path = os.path.join(
31 get_package_share_directory(
"moveit_resources_panda_moveit_config"),
33 "ros2_controllers.yaml",
35 ros2_control_node = launch_ros.actions.Node(
36 package=
"controller_manager",
37 executable=
"ros2_control_node",
38 parameters=[ros2_controllers_path],
40 (
"/controller_manager/robot_description",
"/robot_description"),
45 joint_state_broadcaster_spawner = launch_ros.actions.Node(
46 package=
"controller_manager",
49 "joint_state_broadcaster",
50 "--controller-manager-timeout",
52 "--controller-manager",
53 "/controller_manager",
55 ros2_controllers_path,
59 panda_arm_controller_spawner = launch_ros.actions.Node(
60 package=
"controller_manager",
63 "panda_arm_controller",
65 "/controller_manager",
67 ros2_controllers_path,
72 test_container = launch_ros.actions.ComposableNodeContainer(
73 name=
"servo_utils_tests_container",
75 package=
"rclcpp_components",
76 executable=
"component_container_mt",
77 composable_node_descriptions=[
78 launch_ros.descriptions.ComposableNode(
79 package=
"robot_state_publisher",
80 plugin=
"robot_state_publisher::RobotStatePublisher",
81 name=
"robot_state_publisher",
82 parameters=[moveit_config.robot_description],
84 launch_ros.descriptions.ComposableNode(
86 plugin=
"tf2_ros::StaticTransformBroadcasterNode",
87 name=
"static_tf2_broadcaster",
88 parameters=[{
"/child_frame_id":
"panda_link0",
"/frame_id":
"world"}],
94 servo_gtest = launch_ros.actions.Node(
95 executable=launch.substitutions.PathJoinSubstitution(
97 launch.substitutions.LaunchConfiguration(
"test_binary_dir"),
98 "moveit_servo_utils_test",
103 low_pass_filter_coeff,
104 moveit_config.robot_description,
105 moveit_config.robot_description_semantic,
106 moveit_config.robot_description_kinematics,
111 return launch.LaunchDescription(
113 launch.actions.DeclareLaunchArgument(
114 name=
"test_binary_dir",
115 description=
"Binary directory of package "
116 "containing test executables",
119 joint_state_broadcaster_spawner,
120 panda_arm_controller_spawner,
125 launch.actions.RegisterEventHandler(
127 target_action=panda_arm_controller_spawner,
128 on_exit=[servo_gtest],
131 launch_testing.actions.ReadyToTest(),
134 "servo_gtest": servo_gtest,
test_gtest_pass(self, proc_info, servo_gtest)