13 .robot_description(file_path=
"config/panda.urdf.xacro")
18 ros2_controllers_path = os.path.join(
19 get_package_share_directory(
"moveit_resources_panda_moveit_config"),
21 "ros2_controllers.yaml",
23 ros2_control_node = launch_ros.actions.Node(
24 package=
"controller_manager",
25 executable=
"ros2_control_node",
26 parameters=[ros2_controllers_path],
28 (
"/controller_manager/robot_description",
"/robot_description"),
33 joint_state_broadcaster_spawner = launch_ros.actions.Node(
34 package=
"controller_manager",
37 "joint_state_broadcaster",
38 "--controller-manager-timeout",
40 "--controller-manager",
41 "/controller_manager",
43 ros2_controllers_path,
48 panda_arm_controller_spawner = launch_ros.actions.Node(
49 package=
"controller_manager",
52 "panda_arm_controller",
54 "/controller_manager",
56 ros2_controllers_path,
60 psm_gtest = launch_ros.actions.Node(
61 executable=launch.substitutions.PathJoinSubstitution(
63 launch.substitutions.LaunchConfiguration(
"test_binary_dir"),
64 "planning_scene_monitor_test",
68 moveit_config.to_dict(),
73 return launch.LaunchDescription(
75 launch.actions.TimerAction(period=2.0, actions=[ros2_control_node]),
76 launch.actions.TimerAction(
77 period=4.0, actions=[joint_state_broadcaster_spawner]
79 launch.actions.TimerAction(
80 period=6.0, actions=[panda_arm_controller_spawner]
82 launch.actions.TimerAction(period=9.0, actions=[psm_gtest]),
83 launch_testing.actions.ReadyToTest(),
86 "psm_gtest": psm_gtest,
test_gtest_pass(self, proc_info, psm_gtest)