-
Notifications
You must be signed in to change notification settings - Fork 171
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Signed-off-by: Brian Chen <[email protected]>
- Loading branch information
Showing
1 changed file
with
226 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,226 @@ | ||
# Copyright 2022 Open Source Robotics Foundation, Inc. | ||
# | ||
# Licensed under the Apache License, Version 2.0 (the "License"); | ||
# you may not use this file except in compliance with the License. | ||
# You may obtain a copy of the License at | ||
# | ||
# http://www.apache.org/licenses/LICENSE-2.0 | ||
# | ||
# Unless required by applicable law or agreed to in writing, software | ||
# distributed under the License is distributed on an "AS IS" BASIS, | ||
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | ||
# See the License for the specific language governing permissions and | ||
# limitations under the License. | ||
|
||
import contextlib | ||
import os | ||
import sys | ||
import time | ||
import unittest | ||
import xmlrpc | ||
|
||
from launch import LaunchDescription | ||
from launch.actions import ExecuteProcess | ||
from launch_ros.actions import Node | ||
import launch_testing | ||
import launch_testing.actions | ||
import launch_testing.asserts | ||
import launch_testing.markers | ||
import launch_testing.tools | ||
import launch_testing_ros.tools | ||
|
||
import pytest | ||
|
||
import rclpy | ||
from rclpy.utilities import get_available_rmw_implementations | ||
|
||
from ros2cli.node.strategy import NodeStrategy | ||
|
||
|
||
TEST_NODE = 'test_node' | ||
TEST_NAMESPACE = '/foo' | ||
TEST_TIMEOUT = 20.0 | ||
|
||
# Skip cli tests on Windows while they exhibit pathological behavior | ||
# https://github.com/ros2/build_farmer/issues/248 | ||
if sys.platform.startswith('win'): | ||
pytest.skip( | ||
'CLI tests can block for a pathological amount of time on Windows.', | ||
allow_module_level=True) | ||
|
||
|
||
@pytest.mark.rostest | ||
@launch_testing.parametrize('rmw_implementation', get_available_rmw_implementations()) | ||
def generate_test_description(rmw_implementation): | ||
path_to_fixtures = os.path.join(os.path.dirname(__file__), 'fixtures') | ||
additional_env = {'RMW_IMPLEMENTATION': rmw_implementation} | ||
|
||
# Parameter node test fixture | ||
path_to_parameter_node_script = os.path.join(path_to_fixtures, 'parameter_node.py') | ||
parameter_node = Node( | ||
executable=sys.executable, | ||
name=TEST_NODE, | ||
namespace=TEST_NAMESPACE, | ||
arguments=[path_to_parameter_node_script], | ||
additional_env=additional_env | ||
) | ||
|
||
return LaunchDescription([ | ||
# TODO(jacobperron): Provide a common RestartCliDaemon launch action in ros2cli | ||
ExecuteProcess( | ||
cmd=['ros2', 'daemon', 'stop'], | ||
name='daemon-stop', | ||
on_exit=[ | ||
ExecuteProcess( | ||
cmd=['ros2', 'daemon', 'start'], | ||
name='daemon-start', | ||
on_exit=[ | ||
parameter_node, | ||
launch_testing.actions.ReadyToTest(), | ||
], | ||
additional_env=additional_env | ||
) | ||
] | ||
), | ||
]) | ||
|
||
|
||
class TestVerbSet(unittest.TestCase): | ||
|
||
@classmethod | ||
def setUpClass( | ||
cls, | ||
launch_service, | ||
proc_info, | ||
proc_output, | ||
rmw_implementation | ||
): | ||
rmw_implementation_filter = launch_testing_ros.tools.basic_output_filter( | ||
filtered_rmw_implementation=rmw_implementation | ||
) | ||
|
||
@contextlib.contextmanager | ||
def launch_param_set_command(self, arguments): | ||
param_set_command_action = ExecuteProcess( | ||
cmd=['ros2', 'param', 'set', *arguments], | ||
additional_env={ | ||
'RMW_IMPLEMENTATION': rmw_implementation, | ||
}, | ||
name='ros2param-set-cli', | ||
output='screen' | ||
) | ||
with launch_testing.tools.launch_process( | ||
launch_service, param_set_command_action, proc_info, proc_output, | ||
output_filter=rmw_implementation_filter | ||
) as param_set_command: | ||
yield param_set_command | ||
cls.launch_param_set_command = launch_param_set_command | ||
|
||
@contextlib.contextmanager | ||
def launch_param_dump_command(self, arguments): | ||
param_dump_command_action = ExecuteProcess( | ||
cmd=['ros2', 'param', 'dump', *arguments], | ||
additional_env={ | ||
'RMW_IMPLEMENTATION': rmw_implementation, | ||
}, | ||
name='ros2param-dump-cli', | ||
output='screen' | ||
) | ||
with launch_testing.tools.launch_process( | ||
launch_service, param_dump_command_action, proc_info, proc_output, | ||
output_filter=rmw_implementation_filter | ||
) as param_dump_command: | ||
yield param_dump_command | ||
cls.launch_param_dump_command = launch_param_dump_command | ||
|
||
def setUp(self): | ||
# Ensure the daemon node is running and discovers the test node | ||
start_time = time.time() | ||
timed_out = True | ||
with NodeStrategy(None) as node: | ||
while (time.time() - start_time) < TEST_TIMEOUT: | ||
# TODO(jacobperron): Create a generic 'CliNodeError' so we can treat errors | ||
# from DirectNode and DaemonNode the same | ||
try: | ||
services = node.get_service_names_and_types_by_node(TEST_NODE, TEST_NAMESPACE) | ||
except rclpy.node.NodeNameNonExistentError: | ||
continue | ||
except xmlrpc.client.Fault as e: | ||
if 'NodeNameNonExistentError' in e.faultString: | ||
continue | ||
raise | ||
|
||
service_names = [name_type_tuple[0] for name_type_tuple in services] | ||
if ( | ||
len(service_names) > 0 | ||
and f'{TEST_NAMESPACE}/{TEST_NODE}/get_parameters' in service_names | ||
): | ||
timed_out = False | ||
break | ||
if timed_out: | ||
self.fail(f'CLI daemon failed to find test node after {TEST_TIMEOUT} seconds') | ||
|
||
def test_verb_set_single(self): | ||
with self.launch_param_set_command( | ||
arguments=[f'{TEST_NAMESPACE}/{TEST_NODE}', 'int_param', '1'] | ||
) as param_load_command: | ||
assert param_load_command.wait_for_shutdown(timeout=TEST_TIMEOUT) | ||
assert param_load_command.exit_code == launch_testing.asserts.EXIT_OK | ||
assert launch_testing.tools.expect_output( | ||
expected_lines=['Set parameter int_param successful'], | ||
text=param_load_command.output, | ||
strict=True) | ||
|
||
def test_verb_set_multiple(self): | ||
with self.launch_param_set_command( | ||
arguments=[ | ||
f'{TEST_NAMESPACE}/{TEST_NODE}', | ||
'int_param', '1', | ||
'str_param', 'hello world', | ||
'bool_param', 'True', | ||
] | ||
) as param_load_command: | ||
assert param_load_command.wait_for_shutdown(timeout=TEST_TIMEOUT) | ||
assert param_load_command.exit_code == launch_testing.asserts.EXIT_OK | ||
assert launch_testing.tools.expect_output( | ||
expected_lines=[ | ||
'Set parameter int_param successful', | ||
'Set parameter str_param successful', | ||
'Set parameter bool_param successful'], | ||
text=param_load_command.output, | ||
strict=True) | ||
|
||
def test_verb_set_odd_params(self): | ||
with self.launch_param_set_command( | ||
arguments=[ | ||
f'{TEST_NAMESPACE}/{TEST_NODE}', | ||
'int_param', '1', | ||
'str_param', 'hello world', | ||
'bool_param', | ||
] | ||
) as param_load_command: | ||
assert param_load_command.wait_for_shutdown(timeout=TEST_TIMEOUT) | ||
assert param_load_command.exit_code == 2 | ||
assert launch_testing.tools.expect_output( | ||
expected_lines=['ros2 param set: error: Must provide parameter name and value pairs'], | ||
text=param_load_command.output, | ||
strict=False | ||
) | ||
|
||
def test_verb_set_invalid_node(self): | ||
with self.launch_param_set_command( | ||
arguments=[ | ||
f'{TEST_NAMESPACE}/{TEST_NODE}_invalid', | ||
'int_param', '123', | ||
] | ||
) as param_load_command: | ||
assert param_load_command.wait_for_shutdown(timeout=TEST_TIMEOUT) | ||
assert param_load_command.exit_code == 1 | ||
assert launch_testing.tools.expect_output( | ||
expected_lines=['Node not found'], | ||
text=param_load_command.output, | ||
strict=True) | ||
|
||
|
||
if __name__ == '__main__': | ||
unittest.main() |