- Fixed a potential issue where `gripper_actuated_joint_names` might be None by adding a conditional check before appending joint positions. - Updated `rbs_bringup.launch.py` to: - Change `with_gripper` default to `false` - Modify `ee_link_name` from `gripper_grasp_point` to `tool0` - Set `interactive` mode to `true`
55 lines
1.6 KiB
Python
55 lines
1.6 KiB
Python
from launch import LaunchDescription
|
|
from launch.actions import (
|
|
IncludeLaunchDescription,
|
|
OpaqueFunction,
|
|
)
|
|
from launch.launch_description_sources import PythonLaunchDescriptionSource
|
|
from launch.substitutions import (
|
|
PathJoinSubstitution,
|
|
)
|
|
from launch_ros.substitutions import FindPackageShare
|
|
|
|
|
|
def launch_setup(context, *args, **kwargs):
|
|
main_script = IncludeLaunchDescription(
|
|
PythonLaunchDescriptionSource(
|
|
[
|
|
PathJoinSubstitution(
|
|
[FindPackageShare("rbs_runtime"), "launch", "runtime.launch.py"]
|
|
)
|
|
]
|
|
),
|
|
launch_arguments={
|
|
"with_gripper": "false",
|
|
"robot_type": "rbs_arm",
|
|
"description_package": "rbs_arm",
|
|
"description_file": "rbs_arm_modular.xacro",
|
|
"robot_name": "rbs_arm",
|
|
"use_moveit": "false",
|
|
"moveit_config_package": "rbs_arm",
|
|
"moveit_config_file": "rbs_arm.srdf.xacro",
|
|
"use_sim_time": "true",
|
|
"use_controllers": "true",
|
|
"scene_config_file": "",
|
|
"base_link_name": "base_link",
|
|
"ee_link_name": "tool0",
|
|
"control_space": "task",
|
|
"control_strategy": "position",
|
|
"interactive": "true",
|
|
"use_rbs_utils": "true",
|
|
"assembly_config_name": "board_pick_and_place"
|
|
}.items(),
|
|
)
|
|
|
|
nodes_to_start = [
|
|
main_script,
|
|
]
|
|
return nodes_to_start
|
|
|
|
|
|
def generate_launch_description():
|
|
declared_arguments = []
|
|
|
|
return LaunchDescription(
|
|
declared_arguments + [OpaqueFunction(function=launch_setup)]
|
|
)
|