def test_interrupt_default_launcher():
    desc = LaunchDescriptor()
    desc.add_process(
        cmd=[sys.executable, '-c', 'import time', 'time.sleep(30)'],
        name='test_interrupt_default_launcher__python_blocking'
    )

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(desc)

    def thread_target():
        # wait up to 10 seconds to get to the point where at least all of the
        # asyncio-subprocess coroutines have been run (the processes are still
        # not guaranteed to be running yet)
        launcher.wait_on_processes_to_spawn(10)
        if not launcher.are_processes_spawned():
            # if the processes didn't launch after 10 seconds, fail the test
            _thread.interrupt_main()
            assert False, 'launcher never reported processes launched'
        launcher.interrupt_launch()
        # now wait for the launcher to finish and error if if doesn't
        launcher.wait_on_launch_to_finish(60)
        if launcher.is_launch_running():
            # if still running fail the test
            _thread.interrupt_main()
            assert False, 'launcher failed to shutdown'

    t = threading.Thread(target=thread_target)
    t.start()

    try:
        launcher.launch()
    except KeyboardInterrupt:
        assert False, 'failed by watchdog thread, see other AssertionErrors'
    t.join()
def test_interrupt_default_launcher():
    desc = LaunchDescriptor()
    desc.add_process(
        cmd=[sys.executable, '-c', 'import time', 'time.sleep(30)'],
        name='test_interrupt_default_launcher__python_blocking')

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(desc)

    def thread_target():
        # wait up to 10 seconds to get to the point where at least all of the
        # asyncio-subprocess coroutines have been run (the processes are still
        # not guaranteed to be running yet)
        launcher.wait_on_processes_to_spawn(10)
        if not launcher.are_processes_spawned():
            # if the processes didn't launch after 10 seconds, fail the test
            _thread.interrupt_main()
            assert False, 'launcher never reported processes launched'
        launcher.interrupt_launch()
        # now wait for the launcher to finish and error if if doesn't
        launcher.wait_on_launch_to_finish(60)
        if launcher.is_launch_running():
            # if still running fail the test
            _thread.interrupt_main()
            assert False, 'launcher failed to shutdown'

    t = threading.Thread(target=thread_target)
    t.start()

    try:
        launcher.launch()
    except KeyboardInterrupt:
        assert False, 'failed by watchdog thread, see other AssertionErrors'
    t.join()
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()

    package = 'topic_monitor'
    executable = get_executable_path(package_name=package,
                                     executable_name='data_publisher')

    name = 'small'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '1', '--period', '4'],
        name=name,
    )
    name = 'medium'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '50000', '--period', '4'],
        name=name,
    )
    name = 'large'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '100000', '--period', '4'],
        name=name,
    )
    name = 'xlarge'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '150000', '--period', '4'],
        name=name,
    )
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
def test_launch_with_coroutine():
    default_launcher = DefaultLauncher()

    launch_file = os.path.join(os.path.abspath(os.path.dirname(__file__)), 'launch_counter.py')
    launch_descriptor = LaunchDescriptor()
    load_launch_file(launch_file, launch_descriptor, {})

    @asyncio.coroutine
    def coroutine():
        yield from asyncio.sleep(1)
        print('one', file=sys.stderr)
        yield from asyncio.sleep(1)
        print('two', file=sys.stderr)
        yield from asyncio.sleep(1)
        print('three', file=sys.stderr)

    @asyncio.coroutine
    def coroutine2():
        yield from asyncio.sleep(1)
        print('one mississippi', file=sys.stderr)
        yield from asyncio.sleep(1)
        print('two mississippi', file=sys.stderr)
        yield from asyncio.sleep(1)
        print('three mississippi', file=sys.stderr)

    launch_descriptor.add_coroutine(
        coroutine(), name='coroutine', exit_handler=primary_exit_handler)
    # launch_descriptor.add_coroutine(coroutine2())

    print('launch', file=sys.stderr)
    default_launcher.add_launch_descriptor(launch_descriptor)
    rc = default_launcher.launch()
    print('done', rc, file=sys.stderr)
def test_non_primary_return_code():
    # since Python < 3.5 on Windows does not support signaling SIGINT to the subprocesses
    # we can't expect them to shutdown cleanly, therefore we ignore this test
    if os.name == 'nt':
        return

    default_launcher = DefaultLauncher()

    async def coroutine1():
        await asyncio.sleep(1)
        print('one', file=sys.stderr)
        await asyncio.sleep(1)
        print('two', file=sys.stderr)
        return 3

    async def coroutine2():
        await asyncio.sleep(1)
        print('one mississippi', file=sys.stderr)
        return 0

    launch_descriptor = LaunchDescriptor()
    launch_descriptor.add_coroutine(coroutine1(), name='coroutine1')
    launch_descriptor.add_coroutine(
        coroutine2(), name='coroutine2', exit_handler=primary_exit_handler)

    print('launch', file=sys.stderr)
    default_launcher.add_launch_descriptor(launch_descriptor)
    rc = default_launcher.launch()
    print('done', rc, file=sys.stderr)
    assert rc == 3, 'Expected return code is 3'
Beispiel #6
0
def test_logging_long_messages():
    launch_descriptor = LaunchDescriptor()

    output_file = os.path.join(os.path.dirname(__file__),
                               'test_logging_long_messages')
    filtered = get_default_filtered_prefixes()
    handler = create_handler('test_logging_long_messages',
                             launch_descriptor,
                             output_file,
                             filtered_prefixes=filtered)
    assert handler, 'Cannot find appropriate handler for %s' % output_file

    executable = os.path.join(os.getcwd(), 'test_logging_long_messages')
    if os.name == 'nt':
        executable += '.exe'
    launch_descriptor.add_process(
        cmd=[executable],
        name='test_logging_long_messages',
        exit_handler=default_exit_handler,
        output_handlers=[ConsoleOutput(), handler],
    )

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'"

    handler.check()
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()
    package = 'topic_monitor'
    executable = get_executable_path(package_name=package,
                                     executable_name='data_publisher')

    # Strip the logger name from the message format in favor of the shorter executable name
    os.environ['RCUTILS_CONSOLE_OUTPUT_FORMAT'] = '[{severity}] {message}'
    os.environ[
        'PYTHONUNBUFFERED'] = '1'  # force unbuffered output to get prints to sync correctly

    launch_descriptor.add_process(
        cmd=[executable, 'sensor', '--best-effort'],
        name='sensor',
    )
    launch_descriptor.add_process(
        cmd=[executable, 'critical'],
        name='critical',
    )
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
def test_launch_with_coroutine():
    default_launcher = DefaultLauncher()

    launch_file = os.path.join(os.path.abspath(os.path.dirname(__file__)),
                               'launch_counter.py')
    launch_descriptor = LaunchDescriptor()
    load_launch_file(launch_file, launch_descriptor, {})

    async def coroutine():
        await asyncio.sleep(1)
        print('one', file=sys.stderr)
        await asyncio.sleep(1)
        print('two', file=sys.stderr)
        await asyncio.sleep(1)
        print('three', file=sys.stderr)

    async def coroutine2():
        await asyncio.sleep(1)
        print('one mississippi', file=sys.stderr)
        await asyncio.sleep(1)
        print('two mississippi', file=sys.stderr)
        await asyncio.sleep(1)
        print('three mississippi', file=sys.stderr)

    launch_descriptor.add_coroutine(coroutine(),
                                    name='coroutine',
                                    exit_handler=primary_exit_handler)
    # launch_descriptor.add_coroutine(coroutine2())

    print('launch', file=sys.stderr)
    default_launcher.add_launch_descriptor(launch_descriptor)
    rc = default_launcher.launch()
    print('done', rc, file=sys.stderr)
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()
    executable = 'topic_monitor_data_publisher'

    name = 'small'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '1', '--period', '4'],
        name=name,
    )
    name = 'medium'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '50000', '--period', '4'],
        name=name,
    )
    name = 'large'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '100000', '--period', '4'],
        name=name,
    )
    name = 'xlarge'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '150000', '--period', '4'],
        name=name,
    )
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
def test_logging_long_messages():
    launch_descriptor = LaunchDescriptor()

    output_file = os.path.join(os.path.dirname(__file__), 'test_logging_long_messages')
    handler = create_handler(
        'test_logging_long_messages', launch_descriptor, output_file)
    assert handler, 'Cannot find appropriate handler for %s' % output_file

    # Set the output format to a "verbose" format that is expected by the executable output
    os.environ['RCUTILS_CONSOLE_OUTPUT_FORMAT'] = \
        '[{severity}] [{name}]: {message} ({function_name}() at {file_name}:{line_number})'
    executable = os.path.join(os.getcwd(), 'test_logging_long_messages')
    if os.name == 'nt':
        executable += '.exe'
    launch_descriptor.add_process(
        cmd=[executable],
        name='test_logging_long_messages',
        exit_handler=ignore_exit_handler,  # The process will automatically exit after printing.
        output_handlers=[ConsoleOutput(), handler],
    )

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'"

    handler.check()
Beispiel #11
0
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()

    package = 'topic_monitor'
    executable = get_executable_path(package_name=package, executable_name='data_publisher')

    os.environ['PYTHONUNBUFFERED'] = '1'  # force unbuffered output to get prints to sync correctly

    name = 'small'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '1', '--period', '4'],
        name=name,
    )
    name = 'medium'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '50000', '--period', '4'],
        name=name,
    )
    name = 'large'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '100000', '--period', '4'],
        name=name,
    )
    name = 'xlarge'
    launch_descriptor.add_process(
        cmd=[executable, name, '--payload-size', '150000', '--period', '4'],
        name=name,
    )
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
Beispiel #12
0
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()
    add_process_to_descriptor(launch_descriptor, 'small', 1)
    add_process_to_descriptor(launch_descriptor, 'small', 50)
    add_process_to_descriptor(launch_descriptor, 'large', 1)
    add_process_to_descriptor(launch_descriptor, 'large', 50)
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
Beispiel #13
0
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()
    add_process_to_descriptor(launch_descriptor, 'small', 1)
    add_process_to_descriptor(launch_descriptor, 'small', 50)
    add_process_to_descriptor(launch_descriptor, 'large', 1)
    add_process_to_descriptor(launch_descriptor, 'large', 50)
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
Beispiel #14
0
def launch(index):
    default_launcher = DefaultLauncher()

    async def coroutine():
        await asyncio.sleep(1)
        print('message %d' % index, file=sys.stderr)

    launch_descriptor = LaunchDescriptor()
    launch_descriptor.add_coroutine(coroutine(), name='coroutine%d' % index)

    print('launch %d' % index, file=sys.stderr)
    default_launcher.add_launch_descriptor(launch_descriptor)
    rc = default_launcher.launch()
    print('done %d' % index, rc, file=sys.stderr)
Beispiel #15
0
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()

    os.environ[
        'PYTHONUNBUFFERED'] = '1'  # force unbuffered output to get prints to sync correctly

    add_process_to_descriptor(launch_descriptor, 'small', 1)
    add_process_to_descriptor(launch_descriptor, 'small', 50)
    add_process_to_descriptor(launch_descriptor, 'large', 1)
    add_process_to_descriptor(launch_descriptor, 'large', 50)
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
Beispiel #16
0
def launch():
    ld = LaunchDescriptor()

    ld.add_process(cmd=['dummy_laser'], )
    ld.add_process(cmd=['dummy_map_server'], )

    ld.add_process(cmd=[
        'robot_state_publisher',
        os.path.join(file_path, 'single_rrbot.urdf')
    ])

    ld.add_process(cmd=['dummy_joint_states'])

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(ld)
    rc = launcher.launch()

    assert rc == 0, "The launch file failed with exit code '" + str(rc) + "'. "
Beispiel #17
0
def main(argv=sys.argv[1:]):
    parser = argparse.ArgumentParser(
        description='Launch the processes specified in a launch file.')
    parser.add_argument('launch_file',
                        type=file_exists,
                        nargs='+',
                        help='The launch file.')
    args = parser.parse_args(argv)

    arguments = {}

    launcher = DefaultLauncher()
    for launch_file in args.launch_file:
        launch_descriptor = LaunchDescriptor()
        load_launch_file(launch_file, launch_descriptor, arguments)
        launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()
    return rc
Beispiel #18
0
def main():
    launcher = DefaultLauncher()
    launch_descriptor = LaunchDescriptor()
    executable = 'topic_monitor_data_publisher'

    launch_descriptor.add_process(
        cmd=[executable, 'sensor', '--best-effort'],
        name='sensor',
    )
    launch_descriptor.add_process(
        cmd=[executable, 'critical'],
        name='critical',
    )
    launcher.add_launch_descriptor(launch_descriptor)

    rc = launcher.launch()
    if rc != 0:
        print('Something went wrong. Return code: ' + str(rc), file=sys.stderr)
        exit(rc)
Beispiel #19
0
def main(argv=sys.argv[1:]):
    parser = argparse.ArgumentParser(
        description='Launch the processes specified in a launch file.')
    parser.add_argument(
        'launch_file',
        type=file_exists,
        nargs='+',
        help='The launch file.')
    args = parser.parse_args(argv)

    arguments = {}

    launcher = DefaultLauncher()
    for launch_file in args.launch_file:
        launch_descriptor = LaunchDescriptor()
        load_launch_file(launch_file, launch_descriptor, arguments)
        launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()
    return rc
Beispiel #20
0
def lifecycle_demo():
    ld = LaunchDescriptor()

    ld.add_process(
        cmd=['lifecycle_talker'],
    )

    ld.add_process(
        cmd=['lifecycle_listener'],
    )

    ld.add_process(
        cmd=['lifecycle_service_client'],
        exit_handler=primary_exit_handler,
    )

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(ld)
    rc = launcher.launch()

    assert rc == 0, "The launch file failed with exit code '" + str(rc) + "'. "
Beispiel #21
0
def test_matching():
    output_handlers = []

    launch_descriptor = LaunchDescriptor()

    # This temporary directory and files contained in it will be deleted when the process ends.
    tempdir = tempfile.mkdtemp()
    output_file = tempdir + os.sep + 'testfile'
    full_output_file = output_file + '.regex'
    with open(full_output_file, 'w+') as f:
        f.write('this is line \d\nthis is line [a-z]')

    name = 'test_executable_0'

    handler = create_handler(name, launch_descriptor, output_file)

    assert handler, 'Cannot find appropriate handler for %s' % output_file

    output_handlers.append(handler)

    executable_command = [
        sys.executable,
        os.path.join(os.path.abspath(os.path.dirname(__file__)), 'matching.py')
    ]

    launch_descriptor.add_process(cmd=executable_command,
                                  name=name,
                                  exit_handler=ignore_exit_handler,
                                  output_handlers=output_handlers)

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'. "

    for handler in output_handlers:
        handler.check()
Beispiel #22
0
def test_matching():
    output_handlers = []

    launch_descriptor = LaunchDescriptor()

    # This temporary directory and files contained in it will be deleted when the process ends.
    tempdir = tempfile.mkdtemp()
    output_file = tempdir + os.sep + "testfile"
    full_output_file = output_file + ".regex"
    with open(full_output_file, 'w+') as f:
        f.write('this is line \d\nthis is line [a-z]')

    name = "test_executable_0"

    handler = create_handler(name, launch_descriptor, output_file)

    assert handler, 'Cannot find appropriate handler for %s' % output_file

    output_handlers.append(handler)

    executable_command = [
        sys.executable,
        os.path.join(os.path.abspath(os.path.dirname(__file__)), 'matching.py')]

    launch_descriptor.add_process(
        cmd=executable_command,
        name=name,
        exit_handler=ignore_exit_handler,
        output_handlers=output_handlers)

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'. "

    for handler in output_handlers:
        handler.check()
Beispiel #23
0
def test_env():
    ld = LaunchDescriptor()

    sub_env = copy.deepcopy(os.environ)
    sub_env['testenv1'] = 'testval1'
    os.environ['testenv2'] = 'testval2'
    ld.add_process(
        cmd=[
            sys.executable,
            os.path.join(
                os.path.abspath(
                    os.path.dirname(__file__)),
                'check_env.py')],
        name='test_env',
        env=sub_env,
        exit_handler=primary_exit_handler,
    )
    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(ld)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'. "
Beispiel #24
0
def main(argv=sys.argv[1:]):
    parser = argparse.ArgumentParser(
        description='Launch the processes specified in a launch file.')
    parser.add_argument('launch_file',
                        type=file_exists,
                        nargs='+',
                        help='The launch file.')
    parser.add_argument(
        '--args',
        metavar='arg',
        type=str,
        nargs='+',
        help='An argument to the launch file (e.g., arg_name:=value). All '
        'arguments will be passed to each launch file.')
    args = parser.parse_args(argv)

    launcher = DefaultLauncher()
    for launch_file in args.launch_file:
        launch_descriptor = LaunchDescriptor()
        load_launch_file(launch_file, launch_descriptor, args.args)
        launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()
    return rc
Beispiel #25
0
def test_env():
    ld = LaunchDescriptor()

    sub_env = copy.deepcopy(os.environ)
    sub_env['testenv1'] = 'testval1'
    os.environ['testenv2'] = 'testval2'
    ld.add_process(
        cmd=[
            sys.executable,
            os.path.join(
                os.path.abspath(
                    os.path.dirname(__file__)),
                'check_env.py')],
        name='test_env',
        env=sub_env,
        exit_handler=primary_exit_handler,
    )
    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(ld)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'. "
Beispiel #26
0
def launch():
    parser = argparse.ArgumentParser()
    parser.add_argument("-t",
                        "--linemod_templates",
                        help="Path to a .yml file"
                        "containing the LINEMOD templates for the objects to "
                        "be detected. These could be generated with virtual "
                        "kinect (real) training methods. The file must "
                        "contain sequential class IDs and mesh paths for "
                        "each class to allow the pipeline to execute "
                        "correctly. ",
                        type=str)
    parser.add_argument("-c",
                        "--calibration_file",
                        help="Path to a YAML "
                        "calibration file definining the transform from the "
                        "world frame to the camera frame used to collect "
                        "vision data. Please see launch/osrf_calib.yaml for "
                        "an example.",
                        type=str)
    parser.add_argument("-p",
                        "--push-pasta",
                        help="Push pasta boxes off of "
                        "the table.",
                        type=bool)
    parser.add_argument("-r",
                        "--push-ramen",
                        help="Push ramen containers off "
                        "of the table.",
                        type=bool)
    args = parser.parse_args()

    if args.linemod_templates:
        linemod_templates = args.linemod_templates
    else:
        linemod_templates = (get_package_share_directory("picky_robot") +
                             os.sep + 'linemod/cupnoodles_penne.yml')

    if args.calibration_file:
        calibration_file = args.calibration_file
    else:
        calibration_file = (get_package_share_directory("picky_robot") +
                            os.sep + "launch" + os.sep + "osrf_calib.yaml")

    if args.push_pasta:
        push_pasta = args.push_pasta
    else:
        push_pasta = False

    if args.push_ramen:
        push_ramen = args.push_ramen
    else:
        push_ramen = False

    if not push_pasta and not push_ramen:
        push_ramen = True
        push_pasta = True

    if push_pasta and push_ramen:
        push_flag = ""
    elif push_pasta:
        push_flag = "pasta"
    else:
        push_flag = "ramen"

    # parse a YAML file to get the calibration
    with open(calibration_file, 'r') as f:
        doc = yaml.load(f)
        x_offset = doc["x"]
        y_offset = doc["y"]
        z_offset = doc["z"]
        yaw_offset = doc["yaw"]
        pitch_offset = doc["pitch"]
        roll_offset = doc["roll"]
        parent_frame = doc["parent_frame"]
        child_frame = doc["child_frame"]

    ld = LaunchDescriptor()
    ld.add_process(cmd=[
        get_executable_path(package_name='robot_state_publisher',
                            executable_name='robot_state_publisher'),
        (get_package_share_directory("picky_robot") + os.sep + "launch" +
         os.sep + "ur5.urdf")
    ])

    ld.add_process(cmd=[
        get_executable_path(package_name='tf2_ros',
                            executable_name='static_transform_publisher'),
        str(doc["x"]),
        str(doc["y"]),
        str(doc["z"]),
        str(doc["yaw"]),
        str(doc["pitch"]),
        str(doc["roll"]),
        str(doc["parent_frame"]),
        str(doc["child_frame"])
    ])

    ld.add_process(cmd=[
        get_executable_path(package_name='depth_to_pointcloud',
                            executable_name='depth_to_pointcloud_node')
    ])

    ld.add_process(cmd=[
        get_executable_path(package_name='picky_robot',
                            executable_name='linemod_pipeline'),
        linemod_templates, 'b', 'b'
    ])

    ld.add_process(cmd=[
        get_executable_path(package_name='picky_robot',
                            executable_name='picky_robot.py'), push_flag
    ])

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(ld)
    print("launching...")
    rc = launcher.launch()

    assert rc == 0, "The launch file failed with exit code '" + str(rc) + "'. "
def main(argv=sys.argv[1:]):
    launcher = DefaultLauncher()
    launch_descriptor = launch(LaunchDescriptor(), argv)
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()
    return rc
Beispiel #28
0
def test_logging_output_format():
    launch_descriptor = LaunchDescriptor()

    # Re-use the test_logging_long_messages test binary and modify the output format from an
    # environment variable.
    executable = os.path.join(os.getcwd(), 'test_logging_long_messages')
    if os.name == 'nt':
        executable += '.exe'
    env_long = dict(os.environ)
    # In this custom output, the long message is output twice, to test both dynamic allocation and
    # re-allocation.
    env_long['RCUTILS_CONSOLE_OUTPUT_FORMAT'] = \
        '[{{name}}].({severity}) output: {file_name}:{line_number} {message}, again: {message} ({function_name}()){'  # noqa
    name = 'test_logging_output_format_long'
    output_file = os.path.join(os.path.dirname(__file__), name)
    handler = create_handler(name, launch_descriptor, output_file)
    assert handler, 'Cannot find appropriate handler for %s' % output_file
    launch_descriptor.add_process(
        cmd=[executable],
        env=env_long,
        name=name,
        exit_handler=ignore_exit_handler,
        output_handlers=[ConsoleOutput(), handler],
    )

    env_edge_cases = dict(os.environ)
    # This custom output is to check different edge cases of the output format string parsing.
    env_edge_cases[
        'RCUTILS_CONSOLE_OUTPUT_FORMAT'] = '{}}].({unknown_token}) {{{{'
    name = 'test_logging_output_format_edge_cases'
    output_file = os.path.join(os.path.dirname(__file__), name)
    handler = create_handler(name, launch_descriptor, output_file)
    assert handler, 'Cannot find appropriate handler for %s' % output_file
    launch_descriptor.add_process(
        cmd=[executable],
        env=env_edge_cases,
        name=name,
        exit_handler=ignore_exit_handler,
        output_handlers=[ConsoleOutput(), handler],
    )

    env_no_tokens = dict(os.environ)
    # This custom output is to check that there are no issues when no tokens are used.
    env_no_tokens['RCUTILS_CONSOLE_OUTPUT_FORMAT'] = 'no_tokens'
    name = 'test_logging_output_format_no_tokens'
    output_file = os.path.join(os.path.dirname(__file__), name)
    handler = create_handler(name, launch_descriptor, output_file)
    assert handler, 'Cannot find appropriate handler for %s' % output_file
    launch_descriptor.add_process(
        cmd=[executable],
        env=env_no_tokens,
        name=name,
        exit_handler=ignore_exit_handler,
        output_handlers=[ConsoleOutput(), handler],
    )

    launcher = DefaultLauncher()
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()

    assert rc == 0, \
        "The launch file failed with exit code '" + str(rc) + "'"

    handler.check()
Beispiel #29
0
def main(argv=sys.argv[1:]):
    launcher = DefaultLauncher()
    launch_descriptor = launch(LaunchDescriptor(), argv)
    launcher.add_launch_descriptor(launch_descriptor)
    rc = launcher.launch()
    return rc