moveit2
The MoveIt Motion Planning Framework for ROS 2.
Loading...
Searching...
No Matches
demo_ros_api.launch.py
Go to the documentation of this file.
1import os
2import launch
3import launch_ros
4from ament_index_python.packages import get_package_share_directory
5from launch.conditions import IfCondition, UnlessCondition
6from launch.substitutions import LaunchConfiguration
7from launch_param_builder import ParameterBuilder
8from moveit_configs_utils import MoveItConfigsBuilder
9from moveit_configs_utils.launches import generate_spawn_controllers_launch
10
11
13 moveit_config = (
14 MoveItConfigsBuilder("moveit_resources_panda")
15 .robot_description(file_path="config/panda.urdf.xacro")
16 .joint_limits(file_path="config/hard_joint_limits.yaml")
17 .to_moveit_configs()
18 )
19
20 # Launch Servo as a standalone node or as a "node component" for better latency/efficiency
21 launch_as_standalone_node = LaunchConfiguration(
22 "launch_as_standalone_node", default="false"
23 )
24
25 # Get parameters for the Servo node
26 servo_params = {
27 "moveit_servo": ParameterBuilder("moveit_servo")
28 .yaml("config/panda_simulated_config.yaml")
29 .to_dict()
30 }
31
32 # This sets the update rate and planning group name for the acceleration limiting filter.
33 acceleration_filter_update_period = {"update_period": 0.01}
34 planning_group_name = {"planning_group_name": "panda_arm"}
35
36 # RViz
37 rviz_config_file = (
38 get_package_share_directory("moveit_servo")
39 + "/config/demo_rviz_config_ros.rviz"
40 )
41 rviz_node = launch_ros.actions.Node(
42 package="rviz2",
43 executable="rviz2",
44 name="rviz2",
45 output="log",
46 arguments=["-d", rviz_config_file],
47 parameters=[
48 moveit_config.robot_description,
49 moveit_config.robot_description_semantic,
50 ],
51 )
52
53 # ros2_control using FakeSystem as hardware
54 ros2_controllers_path = os.path.join(
55 get_package_share_directory("moveit_resources_panda_moveit_config"),
56 "config",
57 "ros2_controllers.yaml",
58 )
59 ros2_control_node = launch_ros.actions.Node(
60 package="controller_manager",
61 executable="ros2_control_node",
62 parameters=[ros2_controllers_path],
63 remappings=[
64 ("/controller_manager/robot_description", "/robot_description"),
65 ],
66 output="screen",
67 )
68
69 # Launch as much as possible in components
70 container = launch_ros.actions.ComposableNodeContainer(
71 name="moveit_servo_demo_container",
72 namespace="/",
73 package="rclcpp_components",
74 executable="component_container_mt",
75 composable_node_descriptions=[
76 # Example of launching Servo as a node component
77 # Launching as a node component makes ROS 2 intraprocess communication more efficient.
78 launch_ros.descriptions.ComposableNode(
79 package="moveit_servo",
80 plugin="moveit_servo::ServoNode",
81 name="servo_node",
82 parameters=[
83 servo_params,
84 acceleration_filter_update_period,
85 planning_group_name,
86 moveit_config.robot_description,
87 moveit_config.robot_description_semantic,
88 moveit_config.robot_description_kinematics,
89 moveit_config.joint_limits,
90 ],
91 condition=UnlessCondition(launch_as_standalone_node),
92 ),
93 launch_ros.descriptions.ComposableNode(
94 package="robot_state_publisher",
95 plugin="robot_state_publisher::RobotStatePublisher",
96 name="robot_state_publisher",
97 parameters=[moveit_config.robot_description],
98 ),
99 launch_ros.descriptions.ComposableNode(
100 package="tf2_ros",
101 plugin="tf2_ros::StaticTransformBroadcasterNode",
102 name="static_tf2_broadcaster",
103 parameters=[{"child_frame_id": "/panda_link0", "frame_id": "/world"}],
104 ),
105 ],
106 output="screen",
107 )
108 # Launch a standalone Servo node.
109 # As opposed to a node component, this may be necessary (for example) if Servo is running on a different PC
110 servo_node = launch_ros.actions.Node(
111 package="moveit_servo",
112 executable="servo_node",
113 name="servo_node",
114 parameters=[
115 servo_params,
116 acceleration_filter_update_period,
117 planning_group_name,
118 moveit_config.robot_description,
119 moveit_config.robot_description_semantic,
120 moveit_config.robot_description_kinematics,
121 moveit_config.joint_limits,
122 ],
123 output="screen",
124 condition=IfCondition(launch_as_standalone_node),
125 )
126
127 return launch.LaunchDescription(
128 [
129 rviz_node,
130 ros2_control_node,
131 generate_spawn_controllers_launch(
132 moveit_config, controller_manager_timeout=300
133 ),
134 servo_node,
135 container,
136 ]
137 )