moveit2
The MoveIt Motion Planning Framework for ROS 2.
Loading...
Searching...
No Matches
demo_twist.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_param_builder import ParameterBuilder
6from moveit_configs_utils import MoveItConfigsBuilder
7from moveit_configs_utils.launches import generate_spawn_controllers_launch
8
9
11 moveit_config = (
12 MoveItConfigsBuilder("moveit_resources_panda")
13 .robot_description(file_path="config/panda.urdf.xacro")
14 .joint_limits(file_path="config/hard_joint_limits.yaml")
15 .robot_description_kinematics()
16 .to_moveit_configs()
17 )
18
19 # Get parameters for the Servo node
20 servo_params = {
21 "moveit_servo": ParameterBuilder("moveit_servo")
22 .yaml("config/panda_simulated_config.yaml")
23 .to_dict()
24 }
25
26 # This sets the update rate and planning group name for the acceleration limiting filter.
27 acceleration_filter_update_period = {"update_period": 0.01}
28 planning_group_name = {"planning_group_name": "panda_arm"}
29
30 # RViz
31 rviz_config_file = (
32 get_package_share_directory("moveit_servo") + "/config/demo_rviz_config.rviz"
33 )
34 rviz_node = launch_ros.actions.Node(
35 package="rviz2",
36 executable="rviz2",
37 name="rviz2",
38 output="log",
39 arguments=["-d", rviz_config_file],
40 parameters=[
41 moveit_config.robot_description,
42 moveit_config.robot_description_semantic,
43 ],
44 )
45
46 # ros2_control using FakeSystem as hardware
47 ros2_controllers_path = os.path.join(
48 get_package_share_directory("moveit_resources_panda_moveit_config"),
49 "config",
50 "ros2_controllers.yaml",
51 )
52 ros2_control_node = launch_ros.actions.Node(
53 package="controller_manager",
54 executable="ros2_control_node",
55 parameters=[ros2_controllers_path],
56 remappings=[
57 ("/controller_manager/robot_description", "/robot_description"),
58 ],
59 output="screen",
60 )
61
62 # Launch as much as possible in components
63 container = launch_ros.actions.ComposableNodeContainer(
64 name="moveit_servo_demo_container",
65 namespace="/",
66 package="rclcpp_components",
67 executable="component_container_mt",
68 composable_node_descriptions=[
69 launch_ros.descriptions.ComposableNode(
70 package="robot_state_publisher",
71 plugin="robot_state_publisher::RobotStatePublisher",
72 name="robot_state_publisher",
73 parameters=[moveit_config.robot_description],
74 ),
75 launch_ros.descriptions.ComposableNode(
76 package="tf2_ros",
77 plugin="tf2_ros::StaticTransformBroadcasterNode",
78 name="static_tf2_broadcaster",
79 parameters=[{"child_frame_id": "/panda_link0", "frame_id": "/world"}],
80 ),
81 ],
82 output="screen",
83 )
84 # Launch a standalone Servo node.
85 # As opposed to a node component, this may be necessary (for example) if Servo is running on a different PC
86 servo_node = launch_ros.actions.Node(
87 package="moveit_servo",
88 executable="demo_twist",
89 parameters=[
90 servo_params,
91 acceleration_filter_update_period,
92 planning_group_name,
93 moveit_config.robot_description,
94 moveit_config.robot_description_semantic,
95 moveit_config.robot_description_kinematics,
96 moveit_config.joint_limits,
97 ],
98 output="screen",
99 )
100
101 return launch.LaunchDescription(
102 [
103 rviz_node,
104 ros2_control_node,
105 generate_spawn_controllers_launch(
106 moveit_config, controller_manager_timeout=300
107 ),
108 servo_node,
109 container,
110 ]
111 )