14 file_path=
"config/panda.urdf.xacro",
16 .robot_description_semantic(file_path=
"config/panda.srdf")
18 publish_robot_description=
True, publish_robot_description_semantic=
True
20 .trajectory_execution(file_path=
"config/gripper_moveit_controllers.yaml")
22 pipelines=[
"ompl",
"chomp",
"pilz_industrial_motion_planner",
"stomp"]
28 move_group_node = launch_ros.actions.Node(
29 package=
"moveit_ros_move_group",
30 executable=
"move_group",
32 parameters=[moveit_config.to_dict()],
33 arguments=[
"--ros-args",
"--log-level",
"info"],
37 ros2_controllers_path = os.path.join(
38 get_package_share_directory(
"moveit_resources_panda_moveit_config"),
40 "ros2_controllers.yaml",
42 ros2_control_node = launch_ros.actions.Node(
43 package=
"controller_manager",
44 executable=
"ros2_control_node",
45 parameters=[ros2_controllers_path],
47 (
"/controller_manager/robot_description",
"/robot_description"),
52 joint_state_broadcaster_spawner = launch_ros.actions.Node(
53 package=
"controller_manager",
56 "joint_state_broadcaster",
57 "--controller-manager",
58 "/controller_manager",
60 ros2_controllers_path,
65 panda_arm_controller_spawner = launch_ros.actions.Node(
66 package=
"controller_manager",
69 "panda_arm_controller",
71 "/controller_manager",
73 ros2_controllers_path,
77 panda_hand_controller_spawner = launch_ros.actions.Node(
78 package=
"controller_manager",
81 "panda_hand_controller",
83 "/controller_manager",
85 ros2_controllers_path,
90 static_tf_node = launch_ros.actions.Node(
92 executable=
"static_transform_publisher",
93 name=
"static_transform_publisher",
95 arguments=[
"--frame-id",
"world",
"--child-frame-id",
"panda_link0"],
99 robot_state_publisher = launch_ros.actions.Node(
100 package=
"robot_state_publisher",
101 executable=
"robot_state_publisher",
102 name=
"robot_state_publisher",
104 parameters=[moveit_config.robot_description],
107 move_group_gtest = launch_ros.actions.Node(
108 executable=launch.substitutions.PathJoinSubstitution(
110 launch.substitutions.LaunchConfiguration(
"test_binary_dir"),
111 "move_group_api_test",
114 parameters=[moveit_config.to_dict()],
118 return launch.LaunchDescription(
120 launch.actions.DeclareLaunchArgument(
121 name=
"test_binary_dir",
122 description=
"Binary directory of package "
123 "containing test executables",
126 robot_state_publisher,
129 joint_state_broadcaster_spawner,
130 panda_arm_controller_spawner,
131 panda_hand_controller_spawner,
134 launch_testing.actions.ReadyToTest(),
137 "move_group_gtest": move_group_gtest,
test_gtest_pass(self, proc_info, move_group_gtest)