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