23 common_launch = generate_common_hybrid_launch_description()
26 .robot_description(file_path=
"config/panda.urdf.xacro")
30 hybrid_planning_gtest = Node(
31 executable=PathJoinSubstitution(
32 [LaunchConfiguration(
"test_binary_dir"),
"test_basic_integration"]
35 moveit_config.to_dict(),
43 executable=
"static_transform_publisher",
44 name=
"static_transform_publisher",
46 arguments=[
"--frame-id",
"world",
"--child-frame-id",
"panda_link0"],
50 robot_state_publisher = Node(
51 package=
"robot_state_publisher",
52 executable=
"robot_state_publisher",
53 name=
"robot_state_publisher",
55 parameters=[moveit_config.robot_description],
59 ros2_controllers_path = os.path.join(
60 get_package_share_directory(
"moveit_hybrid_planning"),
62 "demo_controller.yaml",
64 ros2_control_node = Node(
65 package=
"controller_manager",
66 executable=
"ros2_control_node",
67 parameters=[moveit_config.robot_description, ros2_controllers_path],
71 joint_state_broadcaster_spawner = Node(
72 package=
"controller_manager",
75 "joint_state_broadcaster",
76 "--controller-manager",
77 "/controller_manager",
79 ros2_controllers_path,
83 panda_joint_group_position_controller_spawner = Node(
84 package=
"controller_manager",
87 "panda_joint_group_position_controller",
89 "/controller_manager",
91 ros2_controllers_path,
95 return LaunchDescription(
97 DeclareLaunchArgument(
98 name=
"test_binary_dir",
99 description=
"Binary directory of package "
100 "containing test executables",
105 RegisterEventHandler(
107 target_action=panda_joint_group_position_controller_spawner,
108 on_exit=[hybrid_planning_gtest],
111 launch_testing.actions.ReadyToTest(),
116 robot_state_publisher,
118 joint_state_broadcaster_spawner,
119 panda_joint_group_position_controller_spawner,
122 "hybrid_planning_gtest": hybrid_planning_gtest,
test_gtest_pass(self, proc_info, hybrid_planning_gtest)