26
26
# ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27
27
# POSSIBILITY OF SUCH DAMAGE.
28
28
29
+ import os
30
+
29
31
import launch
30
32
from launch .substitutions import (
31
33
Command ,
34
36
PathJoinSubstitution ,
35
37
)
36
38
import launch_ros
37
- import os
38
39
39
40
40
41
def generate_launch_description ():
41
42
description_pkg_share = launch_ros .substitutions .FindPackageShare (
42
- package = " robotiq_description"
43
- ).find (" robotiq_description" )
43
+ package = ' robotiq_description'
44
+ ).find (' robotiq_description' )
44
45
default_model_path = os .path .join (
45
- description_pkg_share , " urdf" , " robotiq_2f_85_gripper.urdf.xacro"
46
+ description_pkg_share , ' urdf' , ' robotiq_2f_85_gripper.urdf.xacro'
46
47
)
47
48
default_rviz_config_path = os .path .join (
48
- description_pkg_share , " rviz" , " view_urdf.rviz"
49
+ description_pkg_share , ' rviz' , ' view_urdf.rviz'
49
50
)
50
51
51
52
pkg_share = launch_ros .substitutions .FindPackageShare (
52
- package = " robotiq_driver"
53
- ).find (" robotiq_driver" )
53
+ package = ' robotiq_driver'
54
+ ).find (' robotiq_driver' )
54
55
55
56
args = []
56
57
args .append (
57
58
launch .actions .DeclareLaunchArgument (
58
- name = " model" ,
59
+ name = ' model' ,
59
60
default_value = default_model_path ,
60
- description = " Absolute path to gripper URDF file" ,
61
+ description = ' Absolute path to gripper URDF file' ,
61
62
)
62
63
)
63
64
args .append (
64
65
launch .actions .DeclareLaunchArgument (
65
- name = " rvizconfig" ,
66
+ name = ' rvizconfig' ,
66
67
default_value = default_rviz_config_path ,
67
- description = " Absolute path to rviz config file" ,
68
+ description = ' Absolute path to rviz config file' ,
68
69
)
69
70
)
70
71
71
72
robot_description_content = Command (
72
73
[
73
- PathJoinSubstitution ([FindExecutable (name = " xacro" )]),
74
- " " ,
75
- LaunchConfiguration (" model" ),
76
- " " ,
77
- " use_fake_hardware:=false" ,
74
+ PathJoinSubstitution ([FindExecutable (name = ' xacro' )]),
75
+ ' ' ,
76
+ LaunchConfiguration (' model' ),
77
+ ' ' ,
78
+ ' use_fake_hardware:=false' ,
78
79
]
79
80
)
80
81
robot_description_param = {
81
- " robot_description" : launch_ros .parameter_descriptions .ParameterValue (
82
+ ' robot_description' : launch_ros .parameter_descriptions .ParameterValue (
82
83
robot_description_content , value_type = str
83
84
)
84
85
}
85
86
86
87
update_rate_config_file = PathJoinSubstitution (
87
88
[
88
89
pkg_share ,
89
- " config" ,
90
- " robotiq_update_rate.yaml" ,
90
+ ' config' ,
91
+ ' robotiq_update_rate.yaml' ,
91
92
]
92
93
)
93
94
94
- controllers_file = " robotiq_controllers.yaml"
95
+ controllers_file = ' robotiq_controllers.yaml'
95
96
initial_joint_controllers = PathJoinSubstitution (
96
- [pkg_share , " config" , controllers_file ]
97
+ [pkg_share , ' config' , controllers_file ]
97
98
)
98
99
99
100
control_node = launch_ros .actions .Node (
100
- package = " controller_manager" ,
101
- executable = " ros2_control_node" ,
101
+ package = ' controller_manager' ,
102
+ executable = ' ros2_control_node' ,
102
103
parameters = [
103
104
robot_description_param ,
104
105
update_rate_config_file ,
@@ -107,39 +108,39 @@ def generate_launch_description():
107
108
)
108
109
109
110
robot_state_publisher_node = launch_ros .actions .Node (
110
- package = " robot_state_publisher" ,
111
- executable = " robot_state_publisher" ,
111
+ package = ' robot_state_publisher' ,
112
+ executable = ' robot_state_publisher' ,
112
113
parameters = [robot_description_param ],
113
114
)
114
115
115
116
rviz_node = launch_ros .actions .Node (
116
- package = " rviz2" ,
117
- executable = " rviz2" ,
118
- name = " rviz2" ,
119
- output = " log" ,
120
- arguments = ["-d" , LaunchConfiguration (" rvizconfig" )],
117
+ package = ' rviz2' ,
118
+ executable = ' rviz2' ,
119
+ name = ' rviz2' ,
120
+ output = ' log' ,
121
+ arguments = ['-d' , LaunchConfiguration (' rvizconfig' )],
121
122
)
122
123
123
124
joint_state_broadcaster_spawner = launch_ros .actions .Node (
124
- package = " controller_manager" ,
125
- executable = " spawner" ,
125
+ package = ' controller_manager' ,
126
+ executable = ' spawner' ,
126
127
arguments = [
127
- " joint_state_broadcaster" ,
128
- " --controller-manager" ,
129
- " /controller_manager" ,
128
+ ' joint_state_broadcaster' ,
129
+ ' --controller-manager' ,
130
+ ' /controller_manager' ,
130
131
],
131
132
)
132
133
133
134
robotiq_gripper_controller_spawner = launch_ros .actions .Node (
134
- package = " controller_manager" ,
135
- executable = " spawner" ,
136
- arguments = [" robotiq_gripper_controller" , "-c" , " /controller_manager" ],
135
+ package = ' controller_manager' ,
136
+ executable = ' spawner' ,
137
+ arguments = [' robotiq_gripper_controller' , '-c' , ' /controller_manager' ],
137
138
)
138
139
139
140
robotiq_activation_controller_spawner = launch_ros .actions .Node (
140
- package = " controller_manager" ,
141
- executable = " spawner" ,
142
- arguments = [" robotiq_activation_controller" , "-c" , " /controller_manager" ],
141
+ package = ' controller_manager' ,
142
+ executable = ' spawner' ,
143
+ arguments = [' robotiq_activation_controller' , '-c' , ' /controller_manager' ],
143
144
)
144
145
145
146
nodes = [
0 commit comments