sm_test_moveit_ur5e_gazebo_sim Namespace Reference

Functions
def	construct_angle_radians (loader, node)
def	construct_angle_degrees (loader, node)
def	load_yaml (package_name, file_path)
def	launch_setup (context, *args, **kwargs)
def	generate_launch_description ()

Function Documentation

construct_angle_degrees()

def sm_test_moveit_ur5e_gazebo_sim.construct_angle_degrees	(		loader,
			node
	)

utility function for converting degrees into radians from yaml.

Definition at line 42 of file sm_test_moveit_ur5e_gazebo_sim.launch.py.

def construct_angle_degrees(loader, node):
    """utility function for converting degrees into radians from yaml."""
    return math.radians(construct_angle_radians(loader, node))
 
 

References construct_angle_radians().

Here is the call graph for this function:

construct_angle_radians()

def sm_test_moveit_ur5e_gazebo_sim.construct_angle_radians	(		loader,
			node
	)

utility function to construct radian values from yaml.

Definition at line 33 of file sm_test_moveit_ur5e_gazebo_sim.launch.py.

def construct_angle_radians(loader, node):
    """utility function to construct radian values from yaml."""
    value = loader.construct_scalar(node)
    try:
        return float(value)
    except SyntaxError:
        raise Exception("invalid expression: %s" % value)
 
 

Referenced by construct_angle_degrees().

Here is the caller graph for this function:

generate_launch_description()

def sm_test_moveit_ur5e_gazebo_sim.generate_launch_description

(

)

Definition at line 212 of file sm_test_moveit_ur5e_gazebo_sim.launch.py.

def generate_launch_description():
    declared_arguments = []
    # General arguments
    declared_arguments.append(
        DeclareLaunchArgument(
            "runtime_config_package",
            default_value="ur_bringup",
            description='Package with the controller\'s configuration in "config" folder. \
        Usually the argument is not set, it enables use of a custom setup.',
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "controllers_file",
            default_value="ur_controllers.yaml",
            description="YAML file with the controllers configuration.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "description_package",
            default_value="ur_description",
            description="Description package with robot URDF/XACRO files. Usually the argument \
        is not set, it enables use of a custom description.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "description_file",
            default_value="ur.urdf.xacro",
            description="URDF/XACRO description file with the robot.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "moveit_config_package",
            default_value="ur_moveit_config",
            description="MoveIt config package with robot SRDF/XACRO files. Usually the argument \
        is not set, it enables use of a custom moveit config.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "moveit_config_file",
            default_value="ur.srdf.xacro",
            description="MoveIt SRDF/XACRO description file with the robot.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument(
            "prefix",
            default_value='""',
            description="Prefix of the joint names, useful for \
        multi-robot setup. If changed than also joint names in the controllers' configuration \
        have to be updated.",
        )
    )
    declared_arguments.append(
        DeclareLaunchArgument("launch_rviz", default_value="true", description="Launch RViz?")
    )
 
    return LaunchDescription(declared_arguments + [OpaqueFunction(function=launch_setup)])

launch_setup()

def sm_test_moveit_ur5e_gazebo_sim.launch_setup	(		context,
		*	args,
		**	kwargs
	)

Definition at line 67 of file sm_test_moveit_ur5e_gazebo_sim.launch.py.

def launch_setup(context, *args, **kwargs):
 
    ur_type = "ur5e"
 
    # General arguments
    runtime_config_package = LaunchConfiguration("runtime_config_package")
    controllers_file = LaunchConfiguration("controllers_file")
    description_package = LaunchConfiguration("description_package")
    description_file = LaunchConfiguration("description_file")
    moveit_config_package = LaunchConfiguration("moveit_config_package")
    moveit_config_file = LaunchConfiguration("moveit_config_file")
    prefix = LaunchConfiguration("prefix")
 
    robot_description_content = Command(
        [
            PathJoinSubstitution([FindExecutable(name="xacro")]),
            " ",
            PathJoinSubstitution(
                [FindPackageShare(description_package), "urdf", description_file]
            ),
            " ",
            "name:=",
            "ur",
            " ",
            "ur_type:=",
            ur_type,
            " ",
            "prefix:=",
            prefix,
            " ",
        ]
    )
    robot_description = {"robot_description": robot_description_content}
 
    # MoveIt Configuration
    robot_description_semantic_content = Command(
        [
            PathJoinSubstitution([FindExecutable(name="xacro")]),
            " ",
            PathJoinSubstitution(
                [FindPackageShare(moveit_config_package), "srdf", moveit_config_file]
            ),
            " ",
            "name:=",
            "ur",
            " ",
            "ur_type:=",
            ur_type,
            " ",
            "prefix:=",
            prefix,
            " ",
        ]
    )
    robot_description_semantic = {"robot_description_semantic": robot_description_semantic_content}
 
    kinematics_yaml = load_yaml("ur_moveit_config", "config/kinematics.yaml")
    robot_description_kinematics = {"robot_description_kinematics": kinematics_yaml}
 
    smacc2_sm_config = PathJoinSubstitution(
        [
            FindPackageShare("sm_test_moveit_ur5_sim"),
            "config",
            "sm_test_moveit_ur5_sim_config.yaml",
        ]
    )
 
    sm_test_moveit_ur5_sim_node = Node(
        package="sm_test_moveit_ur5_sim",
        executable="sm_test_moveit_ur5_sim_node",
        # prefix="xterm -xrm 'XTerm*scrollBar:  true' -xrm 'xterm*rightScrollBar: true' -hold -sl 10000 -geometry 1000x600 -e gdbserver localhost:3000",
        prefix="xterm -xrm 'XTerm*scrollBar:  true' -xrm 'xterm*rightScrollBar: true' -hold -sl 10000 -geometry 1000x600 -e",
        parameters=[
            {"use_sim_time": True},
            robot_description,
            robot_description_semantic,
            robot_description_kinematics,
            smacc2_sm_config,
        ],
    )
 
    smacc2_sm_rviz = PathJoinSubstitution(
        [
            FindPackageShare("sm_test_moveit_ur5_sim"),
            "rviz",
            "rviz.rviz",
        ]
    )
 
    # Launch rviz
    start_rviz_cmd = Node(
        package="rviz2",
        executable="rviz2",
        name="rviz2",
        arguments=["-d", smacc2_sm_rviz],
        output="screen",
        parameters=[
            {"use_sim_time": True},
            robot_description,
            robot_description_semantic,
            robot_description_kinematics,
        ],
    )
 
    ur_control_launch = IncludeLaunchDescription(
        PythonLaunchDescriptionSource(
            [FindPackageShare("ur_simulation_gazebo"), "/launch", "/ur_sim_control.launch.py"]
        ),
        launch_arguments={
            "ur_type": ur_type,
            "runtime_config_package": runtime_config_package,
            "controllers_file": controllers_file,
            "description_package": description_package,
            "description_file": description_file,
            "prefix": prefix,
            "launch_rviz": "false",
        }.items(),
    )
 
    ur_moveit_launch = IncludeLaunchDescription(
        PythonLaunchDescriptionSource(
            [FindPackageShare("ur_moveit_config"), "/launch", "/ur_moveit.launch.py"]
        ),
        launch_arguments={
            "ur_type": ur_type,
            "description_package": description_package,
            "description_file": description_file,
            "moveit_config_package": moveit_config_package,
            "moveit_config_file": moveit_config_file,
            "use_sim_time": "true",
            "prefix": prefix,
            "launch_rviz": "false",
        }.items(),
    )
 
    nodes_to_launch = [
        ur_control_launch,
        ur_moveit_launch,
        sm_test_moveit_ur5_sim_node,
        start_rviz_cmd,
    ]
 
    return nodes_to_launch
 
 

References load_yaml().

Here is the call graph for this function:

load_yaml()

def sm_test_moveit_ur5e_gazebo_sim.load_yaml	(		package_name,
			file_path
	)

Definition at line 47 of file sm_test_moveit_ur5e_gazebo_sim.launch.py.

def load_yaml(package_name, file_path):
    package_path = get_package_share_directory(package_name)
    absolute_file_path = os.path.join(package_path, file_path)
 
    try:
        yaml.SafeLoader.add_constructor("!radians", construct_angle_radians)
        yaml.SafeLoader.add_constructor("!degrees", construct_angle_degrees)
    except Exception:
        raise Exception("yaml support not available; install python-yaml")
 
    try:
        with open(absolute_file_path) as file:
            return yaml.safe_load(file)
    except OSError:  # parent of IOError, OSError *and* WindowsError where available
        return None
 
 
# TODO(destogl): END this should be removed when MoveIt can handle parameters properly
 
 

Referenced by launch_setup().

Here is the caller graph for this function: