17 .robot_description(file_path=
"config/panda.urdf.xacro")
22 launch_as_standalone_node = LaunchConfiguration(
23 "launch_as_standalone_node", default=
"true"
28 "moveit_servo": ParameterBuilder(
"moveit_servo")
29 .yaml(
"config/test_config_panda.yaml")
34 acceleration_filter_update_period = {
"update_period": 0.01}
35 planning_group_name = {
"planning_group_name":
"panda_arm"}
38 ros2_controllers_path = os.path.join(
39 get_package_share_directory(
"moveit_resources_panda_moveit_config"),
41 "ros2_controllers.yaml",
43 ros2_control_node = launch_ros.actions.Node(
44 package=
"controller_manager",
45 executable=
"ros2_control_node",
46 parameters=[ros2_controllers_path],
48 (
"/controller_manager/robot_description",
"/robot_description"),
53 joint_state_broadcaster_spawner = launch_ros.actions.Node(
54 package=
"controller_manager",
57 "joint_state_broadcaster",
58 "--controller-manager-timeout",
60 "--controller-manager",
61 "/controller_manager",
63 ros2_controllers_path,
68 panda_arm_controller_spawner = launch_ros.actions.Node(
69 package=
"controller_manager",
72 "panda_arm_controller",
74 "/controller_manager",
76 ros2_controllers_path,
81 container = launch_ros.actions.ComposableNodeContainer(
82 name=
"moveit_servo_demo_container",
84 package=
"rclcpp_components",
85 executable=
"component_container_mt",
86 composable_node_descriptions=[
89 launch_ros.descriptions.ComposableNode(
90 package=
"moveit_servo",
91 plugin=
"moveit_servo::ServoNode",
95 acceleration_filter_update_period,
97 moveit_config.robot_description,
98 moveit_config.robot_description_semantic,
99 moveit_config.robot_description_kinematics,
101 condition=UnlessCondition(launch_as_standalone_node),
103 launch_ros.descriptions.ComposableNode(
104 package=
"robot_state_publisher",
105 plugin=
"robot_state_publisher::RobotStatePublisher",
106 name=
"robot_state_publisher",
107 parameters=[moveit_config.robot_description],
109 launch_ros.descriptions.ComposableNode(
111 plugin=
"tf2_ros::StaticTransformBroadcasterNode",
112 name=
"static_tf2_broadcaster",
113 parameters=[{
"child_frame_id":
"/panda_link0",
"frame_id":
"/world"}],
120 servo_node = launch_ros.actions.Node(
121 package=
"moveit_servo",
122 executable=
"servo_node",
126 acceleration_filter_update_period,
128 moveit_config.robot_description,
129 moveit_config.robot_description_semantic,
130 moveit_config.robot_description_kinematics,
133 condition=IfCondition(launch_as_standalone_node),
136 servo_gtest = launch_ros.actions.Node(
137 executable=launch.substitutions.PathJoinSubstitution(
139 launch.substitutions.LaunchConfiguration(
"test_binary_dir"),
140 "moveit_servo_ros_integration_test",
146 return launch.LaunchDescription(
150 launch.actions.TimerAction(period=3.0, actions=[ros2_control_node]),
151 launch.actions.TimerAction(
152 period=5.0, actions=[joint_state_broadcaster_spawner]
154 launch.actions.TimerAction(
155 period=7.0, actions=[panda_arm_controller_spawner]
160 launch.actions.RegisterEventHandler(
162 target_action=panda_arm_controller_spawner,
163 on_exit=[servo_gtest],
166 launch_testing.actions.ReadyToTest(),
169 "servo_gtest": servo_gtest,
test_gtest_pass(self, proc_info, servo_gtest)