Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

System test failures occur when running 100s of times #1079

Closed
mkhansenbot opened this issue Aug 29, 2019 · 34 comments
Closed

System test failures occur when running 100s of times #1079

mkhansenbot opened this issue Aug 29, 2019 · 34 comments
Assignees
Labels
2 - Medium Medium Priority

Comments

@mkhansenbot
Copy link
Collaborator

Bug report

This is not a single issue, but a meta-ticket for discussing the system test failures that are occurring.

For example, I ran the system test using the method in #1076 with three different RMW implementations and got these results:
FastRTPS - failed 4/100 times
OpenSplice - failed 17/100 times
CycloneDDS - failed 23/100 times

Required Info:

  • Operating System:
    • Ubuntu 18.04
  • Installation type:
    • Source (master branch as of 8/26/19)
  • Version or commit hash:
  • DDS implementation:
    • multiple (FastRTPS, CycloneDDS, OpenSplice)
  • Client library (if applicable):
    • rclcpp (master branch as of 8/26/19)
    • 17841d6b7cff96efef87400fee2dcd63a6f10101

Steps to reproduce issue

See PR #1076

Expected behavior

Tests should pass 100/100 times

Actual behavior

FastRTPS - failed 4/100 times
OpenSplice - failed 17/100 times
CycloneDDS - failed 23/100 times

Additional information

I'll update the ticket with more info in the comments.

@mkhansenbot
Copy link
Collaborator Author

mkhansenbot commented Aug 29, 2019

Update from @dirk-thomas: resolved by ros2/rclcpp#837

Failure case (1):

FastRTPS - gazebo crashes - this is a failure we see randomly

10: [test_system_node-12] [INFO] [nav2_tester]: Waiting for a few seconds for all nodes to initialize
10: [gzserver-1] [ERROR] [rclcpp]: Couldn't add guard_condition to wait set: guard_conditions set is full, at /home/mkhansen/ros2_dev/ros2_ws/src/ros2/rcl/rcl/src/rcl/wait.c:453
10: [gzserver-1] terminate called after throwing an instance of 'std::runtime_error'
10: [gzserver-1]   what():  Couldn't fill wait set
10: [ERROR] [gzserver-1]: process has died [pid 14171, exit code -6, cmd 'gzserver -s libgazebo_ros_init.so --minimal_comms /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world'].

Edit:
We see this one with all RMW/DDS implementations, so this is likely not a middleware issue, but I'm documenting it here since it is a test failure that occurs outside our code.

This one occurred 2/100 times.

Added by @dirk-thomas:

Log from dirk-thomas experiencing the same failure in the test_localization test.

Start 10: test_localization

10: Test command: /usr/bin/python3 "-u" "/home/dthomas/ros2/ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_localization.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/localization/test_localization_node" "TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models" "--command" "/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py"
10: Test timeout computed to be: 60
10: -- run_test.py: extra environment variables:
10: - TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml
10: - GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models
10: - TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/localization/test_localization_node
10: - TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world
10: -- run_test.py: invoking following command in '/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests':
10: - /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py
10: [INFO] [launch]: All log files can be found below /home/dthomas/.ros/log/2019-08-29-09-12-05-237085-drudge-9753
10: [INFO] [launch]: Default logging verbosity is set to INFO
10: [INFO] [gzserver-1]: process started with pid [9762]
10: [INFO] [static_transform_publisher-2]: process started with pid [9763]
10: [INFO] [static_transform_publisher-3]: process started with pid [9764]
10: [INFO] [map_server-4]: process started with pid [9765]
10: [INFO] [amcl-5]: process started with pid [9766]
10: [INFO] [lifecycle_manager-6]: process started with pid [9767]
10: [INFO] [test_localization_node-7]: process started with pid [9768]
10: [test_localization_node-7] Running main() from /home/dthomas/ros2/ws/install/gtest_vendor/src/gtest_vendor/src/gtest_main.cc
10: [test_localization_node-7] [==========] Running 1 test from 1 test case.
10: [test_localization_node-7] [----------] Global test environment set-up.
10: [test_localization_node-7] [----------] 1 test from TestAmclPose
10: [test_localization_node-7] [ RUN ] TestAmclPose.SimpleAmclTest
10: [gzserver-1] [ERROR] [rclcpp]: Couldn't add guard_condition to wait set: guard_conditions set is full, at /home/dthomas/ros2/github/ros2/rcl/rcl/src/rcl/wait.c:453
10: [gzserver-1] terminate called after throwing an instance of 'std::runtime_error'
10: [gzserver-1] what(): Couldn't fill wait set
10: [ERROR] [gzserver-1]: process has died [pid 9762, exit code -6, cmd 'gzserver -s libgazebo_ros_init.so --minimal_comms /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world'].
10: [amcl-5] [INFO] [amcl]: Creating
10: [amcl-5] [INFO] [amcl]: Configuring
10: [amcl-5] [INFO] [amcl]: initTransforms
10: [amcl-5] [INFO] [amcl]: initPubSub
10: [amcl-5] [INFO] [amcl]: Subscribed to map topic.
10: [amcl-5] [INFO] [amcl]: Activating
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095125.859738): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095125.959736): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.060067): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.160358): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.261599): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.362323): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.462211): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.562469): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.662943): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.763298): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.864978): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095126.965591): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.066797): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.167833): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.267138): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.368231): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.468265): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.570924): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.670493): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.770745): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: Received a 384 X 384 map @ 0.050 m/pix
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.798753): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.872108): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095127.972545): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.072510): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.173759): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.274311): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.373947): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.474592): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.577645): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.675736): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.776944): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.877522): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095128.978238): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.079185): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.178842): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.279199): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.379470): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.480534): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.581160): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.681768): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.782300): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.882220): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095129.983321): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.088630): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.190776): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.289787): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.390043): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.490346): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.590926): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.691114): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.791951): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.892612): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095130.993361): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.094421): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.194955): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.294948): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.395428): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.504397): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.605202): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.706603): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.806093): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095131.907061): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.008065): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.108017): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.209064): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.311469): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.412652): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.512552): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.612697): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.714875): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.814286): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095132.914639): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.017118): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.118272): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.218720): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.318910): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.421322): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.520934): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.621803): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.722543): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.823850): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095133.924045): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.025127): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.124654): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.225802): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.326733): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.426383): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.527008): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.628094): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.728644): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.828941): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095134.930594): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.030209): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.130560): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.231302): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.331527): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.432503): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.533027): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.633920): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.733675): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.834312): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095135.935190): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.035783): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.136366): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.237592): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.338095): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.438679): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.539433): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.640159): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.741482): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.841772): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095136.942560): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.043382): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.143168): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.243793): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.344883): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.445522): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.546891): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.648299): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.748122): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.848545): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095137.949631): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.049567): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.151505): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.252240): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.352725): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.452941): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.553958): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.654742): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.755478): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.856125): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095138.957526): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.058893): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.158427): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.260554): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.360302): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.460849): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.561261): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.661375): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.762518): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.863071): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095139.963988): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.064000): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.164860): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.265792): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.366205): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.466780): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.567568): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.668088): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.768704): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.870357): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095140.970567): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.070417): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.171670): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.272410): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.373755): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.473705): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.574512): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.675071): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.775585): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.876459): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095141.976928): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.077851): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.178379): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.279030): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.380150): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.480645): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.581365): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.682079): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.782568): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.883277): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095142.984085): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.084737): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.184943): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.286023): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.388357): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.488015): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.588614): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.690003): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.790448): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.890778): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095143.992349): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.092303): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.193198): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.293693): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.394312): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.494994): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.595634): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.696208): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.797838): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.898095): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095144.998600): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.099394): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.201140): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.300915): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.401539): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.502095): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.602765): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.703430): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.805305): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095145.905519): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.006453): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.106701): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.207744): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.308336): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.409175): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.509229): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.610599): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.711018): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.810774): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095146.912188): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.012273): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.113513): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.214021): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.314927): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.415714): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.516332): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.617698): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.717453): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.818445): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095147.919030): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.019691): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.120303): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.220179): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.322233): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.422244): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.524520): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.624314): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.724677): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.825109): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095148.925817): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.026885): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.127444): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.228071): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
[Processing: nav2_system_tests]
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.328840): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.428794): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.529807): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.630351): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.731136): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.831684): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095149.932410): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.033016): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.133873): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.234540): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.335250): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.435788): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.536510): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.637247): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.737833): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.838485): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095150.939482): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.040306): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.140048): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.242408): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.342342): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.442774): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.543118): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.644816): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.744812): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.845305): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095151.946140): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.046834): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.146973): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.247220): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.347543): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.448117): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.549197): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.649276): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.749349): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.851155): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095152.950737): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.051989): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.152359): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.252980): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.354027): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.455392): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.555949): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.656396): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.757414): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.858054): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095153.958364): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.059150): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.159671): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.260497): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.361115): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.461862): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.562499): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.663003): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.763972): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.864419): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095154.966002): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.066114): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.167041): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.267593): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.368061): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.468941): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.569561): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.670330): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.770207): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.872124): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095155.972364): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.072705): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.173569): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.274240): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.374711): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.475502): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.576029): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.676883): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.777635): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.878122): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095156.978791): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.079689): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.180414): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.282028): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.381409): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.483117): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.582641): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.683652): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.784381): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.885069): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095157.985721): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.086605): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.187539): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.287286): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.388410): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.488279): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.589862): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.689587): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.791356): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.892144): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095158.992332): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.093173): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.193645): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.294395): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.395025): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.495752): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.596426): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.697169): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.797793): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.897771): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095159.999065): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.099709): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.201340): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.301412): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.401618): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.502963): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.602658): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.703562): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.804695): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095160.905533): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.006116): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.106698): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.207682): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.310251): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.409968): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.511003): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.611513): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.711837): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.812726): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095161.913592): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.015163): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.114594): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.214967): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.315894): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.416643): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.518174): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.617899): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.718546): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.819319): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095162.920070): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.021472): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.121657): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.222253): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.322953): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.423520): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.523649): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.624690): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.725539): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.825960): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095163.926794): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.027747): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.129006): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.229328): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.329988): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.430313): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.531192): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.632016): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.732791): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.833872): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095164.933883): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.034693): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.134691): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.235351): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.336251): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.437600): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.537324): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.638310): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.739465): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.840219): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095165.940659): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.041449): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.141850): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.243175): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.342684): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.444637): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.544169): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.644666): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.745610): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.846267): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095166.947327): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.047002): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.147858): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.248460): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.349562): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.450070): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.551690): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.652102): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.752384): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.852996): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095167.953628): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.054289): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.155501): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.256553): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.357806): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.457230): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.557625): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.658541): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.759073): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.859725): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095168.960488): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.061207): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.162563): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.263503): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.363479): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.464012): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.564896): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.665565): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.765630): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.866525): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095169.966677): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.067465): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.168217): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.268168): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.369418): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.469653): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.570301): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.671093): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.772080): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.872889): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095170.973172): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.073927): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.174848): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.274971): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.375632): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.477453): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.576598): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.677672): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.779109): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.879458): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095171.979470): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.080562): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.180480): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.282374): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.382266): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.482686): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.584467): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.684493): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.785501): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.886447): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095172.986239): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.087674): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.189037): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.288521): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.390600): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.490457): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.590797): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.691049): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.791304): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.892521): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095173.993178): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.094305): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.196001): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.296033): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.396553): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.496340): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.597042): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.698148): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.798600): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095174.899580): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.001336): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.102922): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.202632): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.302403): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.403401): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.505259): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.605242): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.705549): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.806229): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095175.906882): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.007024): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.107378): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.207941): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.308984): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.408808): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.509040): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.610235): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.710959): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.811681): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095176.912385): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.013293): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.113041): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.213294): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.314819): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.415186): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.515241): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.615844): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.716159): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.817707): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095177.918069): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.017826): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.118917): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.219775): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.319673): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.419999): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.521308): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.621530): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.722450): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.824524): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095178.924413): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.025953): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.126239): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.226846): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.327613): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.428219): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.528364): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.629615): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.731277): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.832683): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095179.932413): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.032552): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.133014): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.234046): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.334768): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.434352): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.534906): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.635928): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.737213): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.837808): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567095180.937858): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
[Processing: nav2_system_tests]
1/1 Test #10: test_localization ................***Timeout 60.08 sec

The location where the error message is coming from: https://github.com/ros2/rclcpp/blob/4feecc594559927cdc7689f5e73c6f210608aebc/rclcpp/include/rclcpp/strategies/allocator_memory_strategy.hpp#L236-L242

After some quick debugging the executor resizes the wait set with 6 guard conditions: https://github.com/ros2/rclcpp/blob/4feecc594559927cdc7689f5e73c6f210608aebc/rclcpp/src/rclcpp/executor.cpp#L451-L455
But then it tried to add 7 guard conditions to the wait set: https://github.com/ros2/rclcpp/blob/4feecc594559927cdc7689f5e73c6f210608aebc/rclcpp/include/rclcpp/strategies/allocator_memory_strategy.hpp#L235-L236

🪲 So this looks like a race condition that a different thread adds a condition between the check and the actual use.

@mkhansenbot
Copy link
Collaborator Author

mkhansenbot commented Aug 29, 2019

Failure case (2):

this one is a dwb crash, no idea why, also occurred 2/100 times when running FastRTPS

10: [ERROR] [dwb_controller-7]: process has died [pid 6618, exit code -11, cmd '/home/mkhansen/ros2_dev/navigation2_ws/install/dwb_controller/lib/dwb_controller/dwb_controller --ros-args __params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml'].

We can probably add some exception handling to dwb to 'try catch' whatever's happening here and at least print out a message.

@dirk-thomas
Copy link

dirk-thomas commented Aug 29, 2019

I expect this thread to grow pretty quickly due to the large number of different error cases. Therefore I recommend we label each different case with a unique number, like (N). I did this for your previous two cases.

Also lets focus on FastRTS for now.

For each failure case please include the full output of the test and not only a part.

@dirk-thomas
Copy link

Failure case (3):

test_localization timing out. Likely due to the following reported assertion:

10: [amcl-5] amcl: /home/dthomas/ros2/ws_nav/src/navigation2/nav2_util/src/pf/pf.c:379: pf_update_resample: Assertion `i < set_a->sample_count' failed.
10: [ERROR] [amcl-5]: process has died [pid 5065, exit code -6, cmd '/home/dthomas/ros2/ws_nav/install/nav2_amcl/lib/nav2_amcl/amcl --ros-args'].

Full output of the `test_localization` test
Start 10: test_localization

10: Test command: /usr/bin/python3 "-u" "/home/dthomas/ros2/ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_localization.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/localization/test_localization_node" "TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models" "--command" "/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py"
10: Test timeout computed to be: 60
10: -- run_test.py: extra environment variables:
10: - GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models
10: - TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world
10: - TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml
10: - TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/localization/test_localization_node
10: -- run_test.py: invoking following command in '/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests':
10: - /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py
10: [INFO] [launch]: All log files can be found below /home/dthomas/.ros/log/2019-08-28-23-04-43-985902-drudge-5058
10: [INFO] [launch]: Default logging verbosity is set to INFO
10: [INFO] [gzserver-1]: process started with pid [5061]
10: [INFO] [static_transform_publisher-2]: process started with pid [5062]
10: [INFO] [static_transform_publisher-3]: process started with pid [5063]
10: [INFO] [map_server-4]: process started with pid [5064]
10: [INFO] [amcl-5]: process started with pid [5065]
10: [INFO] [lifecycle_manager-6]: process started with pid [5066]
10: [INFO] [test_localization_node-7]: process started with pid [5067]
10: [test_localization_node-7] Running main() from /home/dthomas/ros2/ws/install/gtest_vendor/src/gtest_vendor/src/gtest_main.cc
10: [test_localization_node-7] [==========] Running 1 test from 1 test case.
10: [test_localization_node-7] [----------] Global test environment set-up.
10: [test_localization_node-7] [----------] 1 test from TestAmclPose
10: [test_localization_node-7] [ RUN ] TestAmclPose.SimpleAmclTest
10: [amcl-5] [INFO] [amcl]: Creating
10: [amcl-5] [INFO] [amcl]: Configuring
10: [amcl-5] [INFO] [amcl]: initTransforms
10: [amcl-5] [INFO] [amcl]: initPubSub
10: [amcl-5] [INFO] [amcl]: Subscribed to map topic.
10: [amcl-5] [INFO] [amcl]: Activating
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058684.785032): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058684.790382): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058684.885893): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058684.986464): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.087255): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.188145): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.288855): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.390849): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.491553): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.592326): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.693184): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.793887): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.894549): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058685.995384): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.096236): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.196827): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.297236): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.398137): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.498866): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.599803): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: Received a 384 X 384 map @ 0.050 m/pix
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.708377): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.713486): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.805623): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058686.902118): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.003085): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.103812): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.204082): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.304757): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.404949): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.505624): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.606126): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.706740): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.807150): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058687.907891): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058688.008228): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058688.108857): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] [INFO] [amcl]: Setting pose (1567058688.209504): -2.000 -0.500 0.000
10: [amcl-5] [INFO] [amcl]: initialPoseReceived
10: [amcl-5] amcl: /home/dthomas/ros2/ws_nav/src/navigation2/nav2_util/src/pf/pf.c:379: pf_update_resample: Assertion `i < set_a->sample_count' failed.
10: [ERROR] [amcl-5]: process has died [pid 5065, exit code -6, cmd '/home/dthomas/ros2/ws_nav/install/nav2_amcl/lib/nav2_amcl/amcl --ros-args'].
10: [amcl-5] [INFO] [amcl]: Settin
[Processing: nav2_system_tests]
[Processing: nav2_system_tests]
1/1 Test #10: test_localization ................***Timeout 60.10 sec

@crdelsey
Copy link
Contributor

I tested RTI Connext

RTI Connext - failed 45/100 times

@dirk-thomas
Copy link

I experienced the failure (1) reported above and attached my full log to the comment: #1079 (comment)

@dirk-thomas
Copy link

Also lets focus on FastRTS for now.

@crdelsey Please keep this focused for now on FastRTPS. Otherwise this ticket will explode in length and become unmanagable.

@mkhansenbot
Copy link
Collaborator Author

Actually looking at the FastRTPS fails, this is the best it has ever looked. The 2 fails I saw yesterday I saw 2x each, and don't look like RMW/DDS issues at all. I believe 1.9.0 might have fixed some issues (at least I hope).

I will run another 100 runs this morning. If someone else can run another 100, that would be a good comparison.

@crdelsey
Copy link
Contributor

The last two times I ran FastRTPS (Tuesday and today) I got 8 and 4 failures out of 100, respectively.

@dirk-thomas
Copy link

The last two times I ran FastRTPS (Tuesday and today) I got 8 and 4 failures out of 100, respectively.

@crdelsey Please post specific failure cases with the necessary details in separate comments. These summary numbers aren't helpful in determining what causes them.

@crdelsey
Copy link
Contributor

Sorry. That data was requested in the thread above. I won't post those numbers again unless something is substantially different.

@mkhansenbot
Copy link
Collaborator Author

@dirk-thomas - I think the statistical numbers are relevant. The fact that Carl and I got similar numbers is good data to have, it means I probably didn't get 'lucky' and that overall FastRTPS has improved vs. Dashing where we were seeing ~85% pass rate.

We do need the logs also, but please don't mark those comments as off-topic.

@crdelsey - can you triage the fails you saw? Do you still have the logs?

@dirk-thomas
Copy link

but please don't mark those comments as off-topic.

We can use a different category - maybe "resolved"?

The goal if this thread is to identify exact failures and resolve them. While the statistics are valuable they don't help with this goal. Therefore I would prefer to fold all comment not describing a specific failure - otherwise the length of this ticket will make it impossible to enumerate / iterate on the actual failures.

@mkhansenbot mkhansenbot added the 2 - Medium Medium Priority label Aug 29, 2019
@mkhansenbot mkhansenbot self-assigned this Aug 29, 2019
@mkhansenbot mkhansenbot added the nav2_wg Request discussion in the nav2 working group label Aug 29, 2019
@mkhansenbot
Copy link
Collaborator Author

@dirk-thomas - BTW the failure (1) above is the same failure seen in the build farm:
http://build.ros2.org/view/Eci/job/Eci__nightly_navigation2_ubuntu_bionic_amd64/lastSuccessfulBuild/testReport/(root)/nav2_system_tests/test_bt_navigator_missing_result/

Thank you for debugging it, are you going to file a bug in rclcpp?

@dirk-thomas
Copy link

The referenced PR should fix failure (1).

@mkhansenbot
Copy link
Collaborator Author

mkhansenbot commented Aug 29, 2019

Failure case (4):

Running another 100x with FastRTPS, same build, same system, this time 12/100 failed. The first fail I see is this:

10: [amcl-6] [WARN] [amcl]: Waiting for map....
10: [amcl-6] double free or corruption (fasttop)
10: [ERROR] [amcl-6]: process has died [pid 4325, exit code -6, cmd '/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl --ros-args __node:=amcl __params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml'].

This may be a bug in amcl, not sure as I've not seen this one before.

Full output of the test 10: Test command: /usr/bin/python3 "-u" "/home/mkhansen/ros2_dev/ros2_ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system" "TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models" "BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml" "ASTAR=True" "--command" "/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py"

10: Test timeout computed to be: 120
10: -- run_test.py: extra environment variables:
10: - ASTAR=True
10: - TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world
10: - GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models
10: - TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml
10: - TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system
10: - BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml
10: -- run_test.py: invoking following command in '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/system':
10: - /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py
10: [INFO] [launch]: All log files can be found below /home/mkhansen/.ros/log/2019-08-29-10-45-14-626430-mkhansen-desk-4317
10: [INFO] [launch]: Default logging verbosity is set to INFO
10: [INFO] [gzserver-1]: process started with pid [4320]
10: [INFO] [static_transform_publisher-2]: process started with pid [4321]
10: [INFO] [static_transform_publisher-3]: process started with pid [4322]
10: [INFO] [map_server-4]: process started with pid [4323]
10: [INFO] [world_model-5]: process started with pid [4324]
10: [INFO] [amcl-6]: process started with pid [4325]
10: [INFO] [dwb_controller-7]: process started with pid [4326]
10: [INFO] [navfn_planner-8]: process started with pid [4327]
10: [INFO] [recoveries_node-9]: process started with pid [4328]
10: [INFO] [bt_navigator-10]: process started with pid [4341]
10: [INFO] [lifecycle_manager-11]: process started with pid [4350]
10: [INFO] [test_system_node-12]: process started with pid [4373]
10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
10: [map_server-4] [INFO] [map_server]: Creating
10: [world_model-5] [INFO] [world_model]: Creating World Model
10: [amcl-6] [INFO] [amcl]: Creating
10: [dwb_controller-7] [INFO] [dwb_controller]: Creating
10: [navfn_planner-8] [INFO] [navfn_planner]: Creating
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Creating Costmap
10: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Creating Costmap
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: �[34m�[1mStarting the system bringup...�[0m�[0m
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: �[34m�[1mCreating and initializing lifecycle service clients�[0m�[0m
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: �[34m�[1mConfiguring and activating map_server�[0m�[0m
10: [recoveries_node-9] [INFO] [recoveries]: Configuring Spin
10: [recoveries_node-9] [INFO] [recoveries]: Configuring BackUp
10: [bt_navigator-10] [INFO] [bt_navigator]: Creating
10: [map_server-4] [INFO] [map_server]: Configuring
10: [map_server-4] [INFO] [map_server]: OccGridLoader: Creating
10: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring
10: [map_server-4] [INFO] [map_server]: Activating
10: [map_server-4] [INFO] [map_server]: OccGridLoader: Activating
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: �[34m�[1mConfiguring and activating amcl�[0m�[0m
10: [amcl-6] [INFO] [amcl]: Configuring
10: [amcl-6] [INFO] [amcl]: initTransforms
10: [amcl-6] [INFO] [amcl]: initPubSub
10: [amcl-6] [INFO] [amcl]: Subscribed to map topic.
10: [amcl-6] [INFO] [amcl]: Activating
10: [lifecycle_manager-11] [INFO] [lifecycle_manager]: �[34m�[1mConfiguring and activating world_model�[0m�[0m
10: [world_model-5] [INFO] [world_model]: Configuring
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Configuring
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "static_layer"
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "obstacle_layer"
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Subscribed to Topics: scan
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "inflation_layer"
10: [world_model-5] [INFO] [global_costmap.global_costmap]: StaticLayer: Resizing costmap to 384 X 384 at 0.050000 m/pix
10: [world_model-5] [INFO] [world_model]: Activating
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Activating
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Checking transform
10: [test_system_node-12] [INFO] [nav2_tester]: Starting test_system_node
10: [test_system_node-12] [INFO] [nav2_tester]: Waiting for a few seconds for all nodes to initialize
10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 separation set to [0.160000m]
10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 diameter set to [0.066000m]
10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Subscribed to [/cmd_vel]
10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Advertise odometry on [/odom]
10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Publishing odom transforms between [odom] and [base_footprint]
10: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_left_joint]
10: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_right_joint]
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00674 timeout was 1.
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00634 timeout was 1.
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00596 timeout was 1.
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.400 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.600 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.800 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.000 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.200 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00654 timeout was 1.
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.600 for reason(0)
10: [amcl-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.800 for reason(0)
10: [amcl-6] [WARN] [amcl]: Waiting for map....
10: [amcl-6] double free or corruption (fasttop)
10: [ERROR] [amcl-6]: process has died [pid 4325, exit code -6, cmd '/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl --ros-args __node:=amcl __params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml'].
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00647 timeout was 1.
10: [test_system_node-12] [INFO] [nav2_tester]: Getting amcl state...
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00666 timeout was 1.
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00673 timeout was 1.
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00611 timeout was 1.
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00641 timeout was 1.
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00667 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0064 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00633 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00677 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00688 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00608 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00604 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00671 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00654 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00687 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00625 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00615 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 13.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 13.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0061 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 13.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 13.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 13.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 14.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 14.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 14.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00624 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 14.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 14.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 15.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 15.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 15.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00607 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 15.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 15.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 16.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 16.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 16.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 16.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00636 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 16.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 17.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 17.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 17.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 17.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 17.801 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00714 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 18.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 18.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 18.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 18.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 18.800 for reason(0)
10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00614 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 19.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 19.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 19.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 19.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 19.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 20.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00634 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 20.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 20.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 20.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 20.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 21.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00682 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 21.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 21.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 21.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 21.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 22.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 22.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00633 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 22.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 22.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 22.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 23.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 23.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00642 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 23.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 23.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 23.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 24.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 24.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 24.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00679 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 24.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 24.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 25.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 25.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 25.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00643 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 25.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 25.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 26.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 26.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 26.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 26.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00677 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 26.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 27.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 27.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 27.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 27.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0063 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 27.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 28.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 28.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 28.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 28.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 28.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00696 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 29.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 29.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 29.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 29.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 29.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00656 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 30.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 30.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 30.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 30.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 30.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 31.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00665 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 31.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 31.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 31.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 31.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 32.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00667 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 32.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 32.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 32.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 32.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 33.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 33.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00682 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 33.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 33.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 33.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 34.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 34.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00663 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 34.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 34.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 34.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 35.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 35.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 35.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00658 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 35.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 35.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 36.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 36.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 36.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00659 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 36.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 36.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 37.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 37.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 37.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 37.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00675 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 37.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 38.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 38.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 38.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 38.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 38.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00688 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 39.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 39.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 39.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 39.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 39.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00651 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 40.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 40.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 40.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 40.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 40.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 41.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00691 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 41.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 41.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 41.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 41.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 42.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00636 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 42.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 42.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 42.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 42.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 43.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 43.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00693 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 43.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 43.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 43.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 44.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 44.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0066 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 44.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 44.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 44.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 45.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 45.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 45.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00626 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 45.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 45.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 46.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 46.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 46.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0063 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 46.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 46.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 47.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 47.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 47.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 47.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00722 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 47.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 48.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 48.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 48.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 48.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00686 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 48.800 for reason(0)
10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 49.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 49.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 49.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 49.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 49.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00669 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 50.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 50.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 50.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 50.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 50.801 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00666 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 51.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 51.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 51.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 51.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 51.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 52.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00676 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 52.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 52.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 52.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 52.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 53.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00677 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 53.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 53.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 53.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 53.800 for reason(0)
10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 54.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 54.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00622 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 54.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 54.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 54.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 55.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 55.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00706 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 55.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 55.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 55.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 56.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 56.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 56.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00643 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 56.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 56.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 57.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 57.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 57.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00646 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 57.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 57.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 58.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 58.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 58.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 58.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00633 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 58.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 59.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 59.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 59.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 59.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 59.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0066 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 60.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 60.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 60.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 60.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 60.801 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00675 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 61.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 61.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 61.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 61.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 61.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 62.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00629 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 62.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 62.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 62.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 62.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 63.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00655 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 63.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 63.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 63.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 63.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 64.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 64.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00646 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 64.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 64.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 64.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 65.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 65.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00639 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 65.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 65.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 65.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 66.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 66.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 66.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00651 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 66.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 66.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 67.001 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 67.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 67.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00619 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 67.601 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 67.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 68.001 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 68.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 68.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 68.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00667 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 68.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 69.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 69.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 69.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 69.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0064 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 69.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 70.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 70.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 70.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 70.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 70.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00674 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 71.001 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 71.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 71.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 71.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 71.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00661 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 72.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 72.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 72.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 72.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 72.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 73.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00681 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 73.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 73.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 73.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 73.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 74.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00647 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 74.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 74.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 74.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 74.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 75.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 75.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00655 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 75.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 75.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 75.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 76.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 76.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00643 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 76.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 76.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 76.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 77.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 77.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 77.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00689 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 77.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 77.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 78.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 78.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 78.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 78.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00662 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 78.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 79.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 79.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 79.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 79.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00616 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 79.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 80.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 80.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 80.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 80.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 80.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00646 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 81.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 81.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 81.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 81.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 81.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00688 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 82.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 82.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 82.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 82.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 82.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 83.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00665 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 83.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 83.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 83.600 for reason(0)
10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 83.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 84.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00654 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 84.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 84.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 84.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 84.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 85.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 85.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00688 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 85.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 85.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 85.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 86.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 86.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00657 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 86.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 86.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 86.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 87.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 87.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 87.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00626 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 87.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 87.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 88.001 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 88.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 88.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00667 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 88.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 88.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 89.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 89.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 89.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 89.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00618 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 89.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 90.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 90.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 90.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 90.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00654 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 90.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 91.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 91.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 91.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 91.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 91.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00614 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 92.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 92.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 92.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 92.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 92.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00677 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 93.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 93.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 93.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 93.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 93.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 94.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00649 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 94.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 94.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 94.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 94.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 95.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00673 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 95.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 95.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 95.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 95.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 96.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 96.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00652 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 96.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 96.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 96.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 97.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 97.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00642 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 97.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 97.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 97.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 98.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 98.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 98.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00641 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 98.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 98.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 99.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 99.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 99.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 99.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00674 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 99.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 100.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 100.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 100.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 100.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0063 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 100.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 101.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 101.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 101.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 101.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 101.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.0069 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 102.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 102.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 102.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 102.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 102.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00643 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 103.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 103.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 103.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 103.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 103.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 104.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00641 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 104.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 104.401 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 104.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 104.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 105.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00667 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 105.201 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 105.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 105.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 105.801 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 106.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 106.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00678 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 106.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 106.600 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 106.800 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 107.000 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 107.200 for reason(0)
10: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00672 timeout was 1.
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 107.400 for reason(0)
10: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 107.600 for reason(0)
[HANDLER_OUTPUT]
1/
1 Test #10: test_bt_navigator ................***Timeout 120.11 sec

0% tests passed, 1 tests failed out of 1

Total Test time (real) = 120.11 sec

The following tests FAILED:
10 - test_bt_navigator (Timeout)
[ERROR_MESSAGE]
Errors while running CTest

@crdelsey
Copy link
Contributor

[amcl-6] double free or corruption (fasttop)

I've seen that one for a while, but only as amcl was shutting down. I don't think I've ever seen it cause the shutdown.

@mkhansenbot
Copy link
Collaborator Author

[amcl-6] double free or corruption (fasttop)

I've seen that one for a while, but only as amcl was shutting down. I don't think I've ever seen it cause the shutdown.

It may only be a symptom, not the cause of the failure. Looking at the amcl code, I can see where it could try to free memory that's already been freed here:
https://github.com/ros-planning/navigation2/blob/97de88d91dd90141486f34a4b45258f03b2874e2/nav2_amcl/src/amcl_node.cpp#L286

We can either check for a null before calling map_free(map_) and pf_free(pf_) or check inside those functions before calling free() itself. The latter is probably safer. I'll file a new issue for this.

@dirk-thomas
Copy link

Please use the latest state when testing. ros2/rclcpp#837 has been merged which resolves the failure (1).

@dirk-thomas
Copy link

Failure case (5)

test_planner timing out. Likely due to the following reported errors:

9: [navfn_planner-1] [ERROR] [getCurrentPose]: No Transform available Error looking up robot pose: "map" passed to lookupTransform argument target_frame does not exist.
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time

Full output of the `test_planner` test
Start 9: test_planner

9: Test command: /usr/bin/python3 "-u" "/home/dthomas/ros2/ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_planner.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_LAUNCH_DIR=" "TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/planning/test_planner_node" "TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map.pgm" "--command" "/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_launch.py"
9: Test timeout computed to be: 60
9: -- run_test.py: extra environment variables:
9: - TEST_LAUNCH_DIR=
9: - TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map.pgm
9: - TEST_EXECUTABLE=/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/planning/test_planner_node
9: -- run_test.py: invoking following command in '/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/planning':
9: - /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_launch.py
[Processing: nav2_system_tests]
9: [INFO] [launch]: All log files can be found below /home/dthomas/.ros/log/2019-08-29-15-06-07-419372-drudge-20025
9: [INFO] [launch]: Default logging verbosity is set to INFO
9: [INFO] [navfn_planner-1]: process started with pid [20028]
9: [INFO] [lifecycle_manager-2]: process started with pid [20029]
9: [INFO] [test_planner_node-3]: process started with pid [20030]
9: [test_planner_node-3] Running main() from /home/dthomas/ros2/ws/install/gtest_vendor/src/gtest_vendor/src/gtest_main.cc
9: [test_planner_node-3] [==========] Running 2 tests from 1 test case.
9: [test_planner_node-3] [----------] Global test environment set-up.
9: [test_planner_node-3] [----------] 2 tests from PlannerTester
9: [test_planner_node-3] [ RUN ] PlannerTester.testSimpleCostmaps
9: [navfn_planner-1] [ERROR] [getCurrentPose]: No Transform available Error looking up robot pose: "map" passed to lookupTransform argument target_frame does not exist.
9: [navfn_planner-1]
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time
9: [test_planner_node-3] /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_node.cpp:55: Failure
9: [test_planner_node-3] Expected equality of these values:
9: [test_planner_node-3] true
9: [test_planner_node-3] defaultPlannerTest(result)
9: [test_planner_node-3] Which is: false
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time
9: [test_planner_node-3] /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_node.cpp:55: Failure
9: [test_planner_node-3] Expected equality of these values:
9: [test_planner_node-3] true
9: [test_planner_node-3] defaultPlannerTest(result)
9: [test_planner_node-3] Which is: false
[Processing: nav2_system_tests]
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time
9: [test_planner_node-3] /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_node.cpp:55: Failure
9: [test_planner_node-3] Expected equality of these values:
9: [test_planner_node-3] true
9: [test_planner_node-3] defaultPlannerTest(result)
9: [test_planner_node-3] Which is: false
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time
9: [test_planner_node-3] /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_node.cpp:55: Failure
9: [test_planner_node-3] Expected equality of these values:
9: [test_planner_node-3] true
9: [test_planner_node-3] defaultPlannerTest(result)
9: [test_planner_node-3] Which is: false
9: [test_planner_node-3] [ERROR] [PlannerTester]: Failed to get a plan within the allowed time
9: [test_planner_node-3] /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/planning/test_planner_node.cpp:55: Failure
9: [test_planner_node-3] Expected equality of these values:
9: [test_planner_node-3] true
9: [test_planner_node-3] defaultPlannerTest(result)
9: [test_planner_node-3] Which is: false
Test #9: test_planner .....................***Timeout 60.04 sec

@dirk-thomas
Copy link

This didn't actually fail the test_bt_navigator test for me but I wanted to post the error message anyway since it seems to indicate a problem:

11: [bt_navigator-10] [ERROR] [bt_navigator]: Navigation failed
11: [bt_navigator-10] terminate called after throwing an instance of 'std::runtime_error'
11: [bt_navigator-10] what(): Asked to publish result for goal that does not exist
11: [ERROR] [bt_navigator-10]: process has died [pid 24442, exit code -6, cmd '/home/dthomas/ros2/ws_nav/install/nav2_bt_navigator/lib/nav2_bt_navigator/bt_navigator --ros-args __node:=bt_navigator __params:=/tmp/launch_params_1587neky __params:=/tmp/launch_params_u9c5u96v'].

@dirk-thomas
Copy link

dirk-thomas commented Aug 29, 2019

Failure case (6):

test_bt_navigator_with_dijkstra timing out. Likely due to the following reported error:

12: [gzserver-1] terminate called after throwing an instance of 'rclcpp::exceptions::RCLError'
12: [gzserver-1] what(): failed to publish message: cannot publish data, at /home/dthomas/ros2/github/ros2/rmw_fastrtps/rmw_fastrtps_shared_cpp/src/rmw_publish.cpp:52, at /home/dthomas/ros2/github/ros2/rcl/rcl/src/rcl/publisher.c:257
12: [ERROR] [gzserver-1]: process has died [pid 25828, exit code -6, cmd 'gzserver -s libgazebo_ros_init.so --minimal_comms /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world'].

Full output of the `test_bt_navigator_with_dijkstra` test
Start 12: test_bt_navigator_with_dijkstra

12: Test command: /usr/bin/python3 "-u" "/home/dthomas/ros2/ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator_with_dijkstra.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_DIR=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/system" "TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models" "BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml" "ASTAR=False" "--command" "/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/system/test_system_launch.py"
12: Test timeout computed to be: 120
12: -- run_test.py: extra environment variables:
12: - GAZEBO_MODEL_PATH=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/models
12: - TEST_MAP=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/maps/map_circular.yaml
12: - TEST_WORLD=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world
12: - TEST_DIR=/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/system
12: - ASTAR=False
12: - BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml
12: -- run_test.py: invoking following command in '/home/dthomas/ros2/ws_nav/build/nav2_system_tests/src/system':
12: - /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/system/test_system_launch.py
12: [INFO] [launch]: All log files can be found below /home/dthomas/.ros/log/2019-08-29-15-34-40-634583-drudge-25825
12: [INFO] [launch]: Default logging verbosity is set to INFO
12: [INFO] [gzserver-1]: process started with pid [25828]
12: [INFO] [static_transform_publisher-2]: process started with pid [25829]
12: [INFO] [static_transform_publisher-3]: process started with pid [25830]
12: [INFO] [map_server-4]: process started with pid [25831]
12: [INFO] [world_model-5]: process started with pid [25832]
12: [INFO] [amcl-6]: process started with pid [25833]
12: [INFO] [dwb_controller-7]: process started with pid [25834]
12: [INFO] [navfn_planner-8]: process started with pid [25835]
12: [INFO] [recoveries_node-9]: process started with pid [25836]
12: [INFO] [bt_navigator-10]: process started with pid [25848]
12: [INFO] [lifecycle_manager-11]: process started with pid [25851]
12: [INFO] [test_system_node-12]: process started with pid [25855]
12: [amcl-6] [WARN] [amcl]: Waiting for map....
12: [amcl-6] [WARN] [amcl]: Waiting for map....
12: [amcl-6] [WARN] [amcl]: Waiting for map....
12: [amcl-6] [WARN] [amcl]: Waiting for map....
12: [world_model-5] [INFO] [world_model]: Creating World Model
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Creating Costmap
12: [world_model-5] [INFO] [world_model]: Configuring
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Configuring
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "static_layer"
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "obstacle_layer"
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Subscribed to Topics: scan
12: [world_model-5] [INFO] [global_costmap.global_costmap]: StaticLayer: Resizing costmap to 384 X 384 at 0.050000 m/pix
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "inflation_layer"
12: [world_model-5] [INFO] [world_model]: Activating
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Activating
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Checking transform
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00828 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00093 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00837 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00119 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00209 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00673 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00815 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00934 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00044 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00816 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00848 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00981 timeout was 1.
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: Lookup would require extrapolation into the past. Requested time 10.12000 but the earliest data is at time 10.60100, when looking up transform from frame [base_link] to frame [map]. canTransform returned after 1.003 timeout was 1.
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.400 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.600 for reason(0)
12: [world_model-5] [INFO] [global_costmap.global_costmap]: start
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 0.801 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.000 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.200 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.400 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.601 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.000 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.601 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.801 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.000 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.601 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.801 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.600 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.200 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.601 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.200 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.600 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.801 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.600 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.601 for reason(0)
[Processing: nav2_system_tests]
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [gzserver-1] terminate called after throwing an instance of 'rclcpp::exceptions::RCLError'
12: [gzserver-1] what(): failed to publish message: cannot publish data, at /home/dthomas/ros2/github/ros2/rmw_fastrtps/rmw_fastrtps_shared_cpp/src/rmw_publish.cpp:52, at /home/dthomas/ros2/github/ros2/rcl/rcl/src/rcl/publisher.c:257
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [ERROR] [gzserver-1]: process has died [pid 25828, exit code -6, cmd 'gzserver -s libgazebo_ros_init.so --minimal_comms /home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world'].
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [WARN] [dwb_controller]: Control loop missed its desired rate of 20.0000Hz
12: [dwb_controller-7] [ERROR] [dwb_controller]: Failed to make progress
[Processing: nav2_system_tests]
12: [test_system_node-12] [INFO] [nav2_tester]: Starting test_system_node
12: [test_system_node-12] [INFO] [nav2_tester]: Waiting for a few seconds for all nodes to initialize
12: [test_system_node-12] [INFO] [nav2_tester]: Getting amcl state...
12: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: active
12: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
12: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
12: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
12: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
12: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
12: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
12: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
12: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
12: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
12: [test_system_node-12] [INFO] [nav2_tester]: Received amcl_pose
12: [test_system_node-12] [INFO] [nav2_tester]: test_InitialPose PASSED
12: [test_system_node-12] [INFO] [nav2_tester]: Getting bt_navigator state...
12: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: unconfigured
12: [test_system_node-12] [INFO] [nav2_tester]: Getting bt_navigator state...
12: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: inactive
12: [test_system_node-12] [INFO] [nav2_tester]: Getting bt_navigator state...
12: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: active
12: [test_system_node-12] [INFO] [nav2_tester]: Setting goal pose
12: [test_system_node-12] [INFO] [nav2_tester]: Waiting 60 seconds for robot to reach goal
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
[Processing: nav2_system_tests]
12: [test_system_node-12] [ERROR] [nav2_tester]: Robot timed out reaching its goal!
12: [test_system_node-12] [ERROR] [nav2_tester]: Test FAILED
12: [test_system_node-12] /home/dthomas/ros2/ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1091: UserWarning: Pass an explicit 'qos_profile' argument
12: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument")
12: [test_system_node-12] /home/dthomas/ros2/ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1156: UserWarning: Pass an explicit 'qos_profile' argument
12: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument")
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.201578235285991
12: [ERROR] [test_system_node-12]: process has died [pid 25855, exit code 1, cmd '/home/dthomas/ros2/ws_nav/src/navigation2/nav2_system_tests/src/system/test_system_node.py'].
12: [INFO] [lifecycle_manager-11]: sending signal 'SIGINT' to process[lifecycle_manager-11]
12: [INFO] [bt_navigator-10]: sending signal 'SIGINT' to process[bt_navigator-10]
12: [INFO] [recoveries_node-9]: sending signal 'SIGINT' to process[recoveries_node-9]
12: [INFO] [navfn_planner-8]: sending signal 'SIGINT' to process[navfn_planner-8]
12: [INFO] [dwb_controller-7]: sending signal 'SIGINT' to process[dwb_controller-7]
12: [INFO] [amcl-6]: sending signal 'SIGINT' to process[amcl-6]
12: [INFO] [world_model-5]: sending signal 'SIGINT' to process[world_model-5]
12: [INFO] [map_server-4]: sending signal 'SIGINT' to process[map_server-4]
12: [INFO] [dwb_controller-7]: process has finished cleanly [pid 25834]
12: [INFO] [static_transform_publisher-3]: sending signal 'SIGINT' to process[static_transform_publisher-3]
12: [INFO] [static_transform_publisher-2]: sending signal 'SIGINT' to process[static_transform_publisher-2]
12: [dwb_controller-7] [foonathan::memory] Allocator foonathan::memory::heap_allocator (at (nil)) leaked 4482080 bytes.
12: [INFO] [map_server-4]: process has finished cleanly [pid 25831]
12: [dwb_controller-7] [INFO] [dwb_controller]: Creating
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Creating Costmap
12: [dwb_controller-7] [INFO] [dwb_controller]: Configuring
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Configuring
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Using plugin "obstacle_layer"
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Subscribed to Topics: scan
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Using plugin "inflation_layer"
12: [dwb_controller-7] [INFO] [dwb_controller]: Setting transform_tolerance to 0.200000
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "RotateToGoal" (dwb_critics::RotateToGoalCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "Oscillation" (dwb_critics::OscillationCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "BaseObstacle" (dwb_critics::BaseObstacleCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "GoalAlign" (dwb_critics::GoalAlignCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "PathAlign" (dwb_critics::PathAlignCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "PathDist" (dwb_critics::PathDistCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Using critic "GoalDist" (dwb_critics::GoalDistCritic)
12: [dwb_controller-7] [INFO] [dwb_controller]: Critic plugin initialized
12: [dwb_controller-7] [INFO] [dwb_controller]: Controller frequency set to 20.0000Hz
12: [dwb_controller-7] [INFO] [dwb_controller]: Activating
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Activating
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Checking transform
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Timed out waiting for transform from base_link to odom to become available, tf error: . canTransform returned after 1.00008 timeout was 1.
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Timed out waiting for transform from base_link to odom to become available, tf error: . canTransform returned after 1.00954 timeout was 1.
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: start
12: [dwb_controller-7] [INFO] [dwb_controller]: Received a goal, begin following path
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [dwb_controller]: Preempting the goal. Passing the new path to the planner.
12: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Received request to clear entirely the local_costmap
12: [dwb_controller-7] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [map_server-4] [foonathan::memory] Allocator foonathan::memory::heap_allocator (at (nil)) leaked 773280 bytes.
12: [map_server-4] [INFO] [map_server]: Creating
12: [map_server-4] [INFO] [map_server]: Configuring
12: [map_server-4] [INFO] [map_server]: OccGridLoader: Creating
12: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring
12: [map_server-4] [INFO] [map_server]: Activating
12: [map_server-4] [INFO] [map_server]: OccGridLoader: Activating
12: [map_server-4] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [INFO] [recoveries_node-9]: process has finished cleanly [pid 25836]
12: [recoveries_node-9] [INFO] [recoveries]: Configuring Spin
12: [recoveries_node-9] [INFO] [recoveries]: Configuring BackUp
12: [recoveries_node-9] [INFO] [recoveries]: Attempting Spin
12: [recoveries_node-9] [INFO] [recoveries]: Turning -1.57 for spin recovery.
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [recoveries]: Spin running...
12: [recoveries_node-9] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [world_model-5] [foonathan::memory] Allocator foonathan::memory::heap_allocator (at (nil)) leaked 2934072 bytes.
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.001 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.601 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.800 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.000 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.201 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.401 for reason(0)
12: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.600 for reason(0)
12: [world_model-5] [INFO] [global_costmap.global_costmap]: Received request to clear entirely the global_costmap
12: [world_model-5] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [world_model-5] [INFO] [world_model]: Destroying
12: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-3] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [INFO] [static_transform_publisher-3]: process has finished cleanly [pid 25830]
12: [INFO] [world_model-5]: process has finished cleanly [pid 25832]
12: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
12: [static_transform_publisher-2] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Starting the system bringup...
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating and initializing lifecycle service clients
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating map_server
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating amcl
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating world_model
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating dwb_controller
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating navfn_planner
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating bt_navigator
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: The system is active
12: [lifecycle_manager-11] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Destroying
12: [INFO] [static_transform_publisher-2]: process has finished cleanly [pid 25829]
12: [INFO] [lifecycle_manager-11]: process has finished cleanly [pid 25851]
12: [amcl-6] [INFO] [amcl]: Creating
12: [amcl-6] [INFO] [amcl]: Configuring
12: [amcl-6] [INFO] [amcl]: initTransforms
12: [amcl-6] [INFO] [amcl]: initPubSub
12: [amcl-6] [INFO] [amcl]: Subscribed to map topic.
12: [amcl-6] [INFO] [amcl]: Activating
12: [amcl-6] [INFO] [amcl]: initialPoseReceived
12: [amcl-6] [INFO] [amcl]: Setting pose (7.674000): -2.000 -0.500 -0.000
12: [amcl-6] [INFO] [amcl]: initialPoseReceived
12: [amcl-6] [INFO] [amcl]: Setting pose (7.674000): -2.000 -0.500 -0.000
12: [amcl-6] [INFO] [amcl]: initialPoseReceived
12: [amcl-6] [INFO] [amcl]: Setting pose (8.660000): -2.000 -0.500 -0.000
12: [amcl-6] [INFO] [amcl]: Received a 384 X 384 map @ 0.050 m/pix
12: [amcl-6] [INFO] [amcl]: Setting pose (9.345000): -2.000 -0.500 -0.000
12: [amcl-6] [INFO] [amcl]: createLaserObject
12: [amcl-6] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [amcl-6] [INFO] [amcl]: Destroying
12: [INFO] [amcl-6]: process has finished cleanly [pid 25833]
12: [navfn_planner-8] [INFO] [navfn_planner]: Creating
12: [navfn_planner-8] [INFO] [navfn_planner]: Configuring
12: [navfn_planner-8] [INFO] [navfn_planner]: Activating
12: [navfn_planner-8] [INFO] [rclcpp]: signal_handler(signal_value=2)
12: [navfn_planner-8] [INFO] [navfn_planner]: Destroying
12: [ERROR] [bt_navigator-10]: process has died [pid 25848, exit code -11, cmd '/home/dthomas/ros2/ws_nav/install/nav2_bt_navigator/lib/nav2_bt_navigator/bt_navigator --ros-args __node:=bt_navigator __params:=/tmp/launch_params_9p6jk51k __params:=/tmp/launch_params_f_pl8gk1'].
12: [INFO] [navfn_planner-8]: process has finished cleanly [pid 25835]
12: -- run_test.py: return code 1
12: -- run_test.py: generate result file '/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator_with_dijkstra.xml' with failed test
12: -- run_test.py: verify result file '/home/dthomas/ros2/ws_nav/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator_with_dijkstra.xml'
Test #12: test_bt_navigator_with_dijkstra ...***Failed 94.45 sec

Also reported here: ros2/rclcpp#827

@mkhansenbot
Copy link
Collaborator Author

Ignore (5) and any fails within test_planner for now. PR #1083 is fixing that test.

I'm only running the bt_navigator test for my runs of 100.

@mkhansenbot
Copy link
Collaborator Author

mkhansenbot commented Aug 31, 2019

Fail (7) - this is new to me. Map server failing to load the map:
10: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring
10: [map_server-4] [ERROR] [map_server]: Failed to load image file /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml/map_circular.pgm for reason: Magick: Unable to open file (/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml/map_circular.pgm) reported by magick/blob.c:3002 (OpenBlob)
10: [map_server-4] [ERROR] []: Caught exception in callback for transition 10
10: [map_server-4] [ERROR] []: Original error: Failed to load map image file.
10: [map_server-4] [WARN] []: Error occurred while doing error handling.
10: [map_server-4] [FATAL] [map_server]: Lifecycle node entered error state
10: [lifecycle_manager-6] [ERROR] [lifecycle_manager]: Failed to change state for node: map_server
10: [lifecycle_manager-6] [ERROR] [lifecycle_manager]: Failed to bring up node: map_server, aborting bringup

10: Test command: /usr/bin/python3 "-u" "/home/mkhansen/ros2_dev/ros2_ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_localization.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_EXECUTABLE=/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/localization/test_localization_node" "TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models" "--command" "/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py" 10: Test timeout computed to be: 60 10: -- run_test.py: extra environment variables: 10: - TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world 10: - TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml 10: - TEST_EXECUTABLE=/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/localization/test_localization_node 10: - GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models 10: -- run_test.py: invoking following command in '/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests': 10: - /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/localization/test_localization_launch.py 10: [INFO] [launch]: All log files can be found below /home/mkhansen/.ros/log/2019-08-30-16-55-19-205802-mkhansen-desk-29879 10: [INFO] [launch]: Default logging verbosity is set to INFO 10: [INFO] [gzserver-1]: process started with pid [29883] 10: [INFO] [static_transform_publisher-2]: process started with pid [29884] 10: [INFO] [static_transform_publisher-3]: process started with pid [29885] 10: [INFO] [map_server-4]: process started with pid [29886] 10: [INFO] [amcl-5]: process started with pid [29887] 10: [INFO] [lifecycle_manager-6]: process started with pid [29888] 10: [INFO] [test_localization_node-7]: process started with pid [29889] 10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment 10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment 10: [test_localization_node-7] Running main() from /home/mkhansen/ros2_dev/ros2_ws/install/gtest_vendor/src/gtest_vendor/src/gtest_main.cc 10: [test_localization_node-7] [==========] Running 1 test from 1 test case. 10: [test_localization_node-7] [----------] Global test environment set-up. 10: [test_localization_node-7] [----------] 1 test from TestAmclPose 10: [test_localization_node-7] [ RUN ] TestAmclPose.SimpleAmclTest 10: [lifecycle_manager-6] [INFO] [lifecycle_manager]: Creating 10: [lifecycle_manager-6] [INFO] [lifecycle_manager]: Starting the system bringup... 10: [lifecycle_manager-6] [INFO] [lifecycle_manager]: Creating and initializing lifecycle service clients 10: [lifecycle_manager-6] [INFO] [lifecycle_manager]: Configuring and activating map_server 10: [amcl-5] [INFO] [amcl]: Creating 10: [map_server-4] [INFO] [map_server]: Creating 10: [map_server-4] [INFO] [map_server]: Configuring 10: [map_server-4] [INFO] [map_server]: OccGridLoader: Creating 10: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring 10: [map_server-4] [ERROR] [map_server]: Failed to load image file /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml/map_circular.pgm for reason: Magick: Unable to open file (/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml/map_circular.pgm) reported by magick/blob.c:3002 (OpenBlob) 10: [map_server-4] [ERROR] []: Caught exception in callback for transition 10 10: [map_server-4] [ERROR] []: Original error: Failed to load map image file. 10: [map_server-4] [WARN] []: Error occurred while doing error handling. 10: [map_server-4] [FATAL] [map_server]: Lifecycle node entered error state 10: [lifecycle_manager-6] [ERROR] [lifecycle_manager]: Failed to change state for node: map_server 10: [lifecycle_manager-6] [ERROR] [lifecycle_manager]: Failed to bring up node: map_server, aborting bringup 10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 separation set to [0.160000m] 10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 diameter set to [0.066000m] 10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Subscribed to [/cmd_vel] 10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Advertise odometry on [/odom] 10: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Publishing odom transforms between [odom] and [base_footprint] 10: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_left_joint] 10: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_right_joint] [Processing: nav2_system_tests] 10: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment 10: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment [Processing: nav2_system_tests] Test #10: test_localization ................***Timeout 60.07 sec

rotu added a commit to RoverRobotics-forks/navigation2 that referenced this issue Sep 1, 2019
crdelsey pushed a commit that referenced this issue Sep 3, 2019
@mkhansenbot
Copy link
Collaborator Author

Fail case (8)

11: [lifecycle_manager-11] [ERROR] [lifecycle_manager]: Failed to change state for node: world_model
11: [lifecycle_manager-11] [ERROR] [lifecycle_manager]: Failed to bring up node: world_model, aborting bringup
11: [lifecycle_manager-11] terminate called after throwing an instance of 'rclcpp::exceptions::RCLError'
11: [lifecycle_manager-11]   what():  Failed to create interrupt guard condition in Executor constructor: the given context is not valid, either rcl_init() was not called or rcl_shutdown() was called., at /home/mkhansen/ros2_dev/ros2_ws/src/ros2/rcl/rcl/src/rcl/guard_condition.c:69

11: Test command: /usr/bin/python3 "-u" "/home/mkhansen/ros2_dev/ros2_ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system" "TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models" "BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml" "ASTAR=True" "--command" "/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py"
11: Test timeout computed to be: 120
11: -- run_test.py: extra environment variables:
11: - TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world
11: - ASTAR=True
11: - GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models
11: - TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml
11: - BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml
11: - TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system
11: -- run_test.py: invoking following command in '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/system':
11: - /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py
11: [INFO] [launch]: All log files can be found below /home/mkhansen/.ros/log/2019-09-03-11-09-37-629342-mkhansen-desk-29462
11: [INFO] [launch]: Default logging verbosity is set to INFO
11: [INFO] [gzserver-1]: process started with pid [29466]
11: [INFO] [static_transform_publisher-2]: process started with pid [29467]
11: [INFO] [static_transform_publisher-3]: process started with pid [29468]
11: [INFO] [map_server-4]: process started with pid [29469]
11: [INFO] [world_model-5]: process started with pid [29470]
11: [INFO] [gdb-6]: process started with pid [29471]
11: [INFO] [dwb_controller-7]: process started with pid [29472]
11: [INFO] [navfn_planner-8]: process started with pid [29473]
11: [INFO] [recoveries_node-9]: process started with pid [29474]
11: [INFO] [bt_navigator-10]: process started with pid [29491]
11: [INFO] [lifecycle_manager-11]: process started with pid [29512]
11: [INFO] [test_system_node-12]: process started with pid [29529]
11: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment
11: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment
11: [map_server-4] [INFO] [map_server]: Creating
11: [world_model-5] [INFO] [world_model]: Creating World Model
11: [dwb_controller-7] [INFO] [dwb_controller]: Creating
11: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Creating Costmap
11: [navfn_planner-8] [INFO] [navfn_planner]: Creating
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Creating Costmap
11: [recoveries_node-9] [INFO] [recoveries]: Configuring Spin
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Starting the system bringup...
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating and initializing lifecycle service clients
11: [bt_navigator-10] [INFO] [bt_navigator]: Creating
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating map_server
11: [recoveries_node-9] [INFO] [recoveries]: Configuring BackUp
11: [map_server-4] [INFO] [map_server]: Configuring
11: [map_server-4] [INFO] [map_server]: OccGridLoader: Creating
11: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring
11: [map_server-4] [INFO] [map_server]: Activating
11: [map_server-4] [INFO] [map_server]: OccGridLoader: Activating
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating amcl
11: [gdb-6] GNU gdb (Ubuntu 8.1-0ubuntu3) 8.1.0.20180409-git
11: [gdb-6] Copyright (C) 2018 Free Software Foundation, Inc.
11: [gdb-6] License GPLv3+: GNU GPL version 3 or later http://gnu.org/licenses/gpl.html
11: [gdb-6] This is free software: you are free to change and redistribute it.
11: [gdb-6] There is NO WARRANTY, to the extent permitted by law. Type "show copying"
11: [gdb-6] and "show warranty" for details.
11: [gdb-6] This GDB was configured as "x86_64-linux-gnu".
11: [gdb-6] Type "show configuration" for configuration details.
11: [gdb-6] For bug reporting instructions, please see:
11: [gdb-6] http://www.gnu.org/software/gdb/bugs/.
11: [gdb-6] Find the GDB manual and other documentation resources online at:
11: [gdb-6] http://www.gnu.org/software/gdb/documentation/.
11: [gdb-6] For help, type "help".
11: [gdb-6] Type "apropos word" to search for commands related to "word"...
11: [gdb-6] Reading symbols from /home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl...(no debugging symbols found)...done.
11: [gdb-6] /home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/system/__params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml: No such file or directory.
11: [gdb-6] Starting program: /home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl
11: [test_system_node-12] [INFO] [nav2_tester]: Starting test_system_node
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for a few seconds for all nodes to initialize
11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 separation set to [0.160000m]
11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 diameter set to [0.066000m]
11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Subscribed to [/cmd_vel]
11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Advertise odometry on [/odom]
11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Publishing odom transforms between [odom] and [base_footprint]
11: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_left_joint]
11: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_right_joint]
11: [gdb-6] [Thread debugging using libthread_db enabled]
11: [gdb-6] Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1".
11: [gdb-6] [New Thread 0x7ffff01b9700 (LWP 29648)]
11: [gdb-6] [New Thread 0x7fffef9b8700 (LWP 29649)]
11: [gdb-6] [New Thread 0x7fffef1b7700 (LWP 29650)]
11: [gdb-6] [New Thread 0x7fffee9b6700 (LWP 29651)]
11: [gdb-6] [New Thread 0x7fffee1b5700 (LWP 29652)]
11: [gdb-6] [New Thread 0x7fffed9b4700 (LWP 29653)]
11: [gdb-6] [New Thread 0x7fffed0b2700 (LWP 29654)]
11: [gdb-6] [New Thread 0x7fffd7fff700 (LWP 29655)]
11: [gdb-6] [New Thread 0x7fffd71ef700 (LWP 29656)]
11: [gdb-6] [INFO] [amcl]: Creating
11: [gdb-6] [INFO] [amcl]: Configuring
11: [gdb-6] [INFO] [amcl]: initTransforms
11: [gdb-6] [New Thread 0x7fffd61ce700 (LWP 29657)]
11: [gdb-6] [INFO] [amcl]: initPubSub
11: [gdb-6] [INFO] [amcl]: Subscribed to map topic.
11: [gdb-6] [INFO] [amcl]: Activating
11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating world_model
11: [world_model-5] [INFO] [world_model]: Configuring
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Configuring
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "static_layer"
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "obstacle_layer"
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Subscribed to Topics: scan
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "inflation_layer"
11: [world_model-5] [INFO] [world_model]: Activating
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Activating
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Checking transform
11: [world_model-5] [INFO] [global_costmap.global_costmap]: StaticLayer: Resizing costmap to 384 X 384 at 0.050000 m/pix
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00397 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00327 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00496 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Getting amcl state...
11: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: active
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00502 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00535 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00377 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00382 timeout was 1.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00276 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534188.440660): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534188.447137): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00357 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534189.455080): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [gdb-6] [INFO] [amcl]: Received a 384 X 384 map @ 0.050 m/pix
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534189.791391): -2.000 -0.500 0.000
[Processing: nav2_system_tests]
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534190.463755): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00334 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534191.472136): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00545 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534192.480650): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00522 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534193.488612): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00383 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534194.496556): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00425 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534195.503968): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00419 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose
11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose
11: [gdb-6] [INFO] [amcl]: initialPoseReceived
11: [gdb-6] [INFO] [amcl]: Setting pose (1567534196.511816): -2.000 -0.500 0.000
11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00503 timeout was 1.
11: [test_system_node-12] [INFO] [nav2_tester]: test_InitialPose FAILED
11: [test_system_node-12] [ERROR] [nav2_tester]: Test FAILED
11: [test_system_node-12] /home/mkhansen/ros2_dev/ros2_ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1091: UserWarning: Pass an explicit 'qos_profile' argument
11: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument")
11: [test_system_node-12] /home/mkhansen/ros2_dev/ros2_ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1156: UserWarning: Pass an explicit 'qos_profile' argument
11: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument")
11: [ERROR] [test_system_node-12]: process has died [pid 29529, exit code 1, cmd '/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_node.py'].
11: [INFO] [lifecycle_manager-11]: sending signal 'SIGINT' to process[lifecycle_manager-11]
11: [INFO] [bt_navigator-10]: sending signal 'SIGINT' to process[bt_navigator-10]
11: [INFO] [recoveries_node-9]: sending signal 'SIGINT' to process[recoveries_node-9]
11: [INFO] [navfn_planner-8]: sending signal 'SIGINT' to process[navfn_planner-8]
11: [INFO] [dwb_controller-7]: sending signal 'SIGINT' to process[dwb_controller-7]
11: [INFO] [gdb-6]: sending signal 'SIGINT' to process[gdb-6]
11: [INFO] [world_model-5]: sending signal 'SIGINT' to process[world_model-5]
11: [INFO] [map_server-4]: sending signal 'SIGINT' to process[map_server-4]
11: [INFO] [static_transform_publisher-3]: sending signal 'SIGINT' to process[static_transform_publisher-3]
11: [INFO] [static_transform_publisher-2]: sending signal 'SIGINT' to process[static_transform_publisher-2]
11: [INFO] [gzserver-1]: sending signal 'SIGINT' to process[gzserver-1]
11: [INFO] [map_server-4]: process has finished cleanly [pid 29469]
11: [lifecycle_manager-11] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [lifecycle_manager-11] [ERROR] [lifecycle_manager]: Failed to change state for node: world_model
11: [lifecycle_manager-11] [ERROR] [lifecycle_manager]: Failed to bring up node: world_model, aborting bringup
11: [lifecycle_manager-11] terminate called after throwing an instance of 'rclcpp::exceptions::RCLError'
11: [lifecycle_manager-11] what(): Failed to create interrupt guard condition in Executor constructor: the given context is not valid, either rcl_init() was not called or rcl_shutdown() was called., at /home/mkhansen/ros2_dev/ros2_ws/src/ros2/rcl/rcl/src/rcl/guard_condition.c:69
11: [bt_navigator-10] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [bt_navigator-10] [INFO] [bt_navigator]: Destroying
11: [INFO] [static_transform_publisher-3]: process has finished cleanly [pid 29468]
11: [recoveries_node-9] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [INFO] [recoveries_node-9]: process has finished cleanly [pid 29474]
11: [INFO] [bt_navigator-10]: process has finished cleanly [pid 29491]
11: [navfn_planner-8] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [dwb_controller-7] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [navfn_planner-8] [INFO] [navfn_planner]: Destroying
11: [dwb_controller-7] [INFO] [dwb_controller]: Destroying
11: [dwb_controller-7] [INFO] [local_costmap.local_costmap]: Destroying
11: [world_model-5] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 0.364533 timeout was 1.
11: [map_server-4] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [gdb-6]
11: [gdb-6] Thread 1 "amcl" received signal SIGINT, Interrupt.
11: [gdb-6] 0x00007ffff52159f3 in futex_wait_cancelable (private=,
11: [gdb-6] expected=0, futex_word=0x555555774f54)
11: [gdb-6] at ../sysdeps/unix/sysv/linux/futex-internal.h:88
11: [gdb-6] 88 ../sysdeps/unix/sysv/linux/futex-internal.h: No such file or directory.
11: [world_model-5] [INFO] [global_costmap.global_costmap]: start
11: [world_model-5] [INFO] [world_model]: Destroying
11: [world_model-5]
11: [world_model-5] >>> [rcutils|error_handling.c:107] rcutils_set_error_state()
11: [world_model-5] This error state is being overwritten:
11: [world_model-5]
11: [world_model-5] 'publisher's context is invalid, at /home/mkhansen/ros2_dev/ros2_ws/src/ros2/rcl/rcl/src/rcl/publisher.c:343'
11: [world_model-5]
11: [world_model-5] with this new error message:
11: [world_model-5]
11: [world_model-5] 'Could not publish transition, at /home/mkhansen/ros2_dev/ros2_ws/src/ros2/rcl/rcl_lifecycle/src/rcl_lifecycle.c:336'
11: [world_model-5]
11: [world_model-5] rcutils_reset_error() should be called after error handling to avoid this.
11: [world_model-5] <<<
11: [world_model-5] [ERROR] []: Failed to finish transition 3. Current state is now: active
11: [static_transform_publisher-3] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [static_transform_publisher-2] [INFO] [rclcpp]: signal_handler(signal_value=2)
11: [INFO] [static_transform_publisher-2]: process has finished cleanly [pid 29467]
11: [INFO] [navfn_planner-8]: process has finished cleanly [pid 29473]
11: [INFO] [dwb_controller-7]: process has finished cleanly [pid 29472]
11: [ERROR] [lifecycle_manager-11]: process has died [pid 29512, exit code -6, cmd '/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_lifecycle_manager/lib/nav2_lifecycle_manager/lifecycle_manager --ros-args __node:=lifecycle_manager __params:=/tmp/launch_params_1slv92rt __params:=/tmp/launch_params_z31beqvz __params:=/tmp/launch_params_d5fvauf4'].
11: [INFO] [world_model-5]: process has finished cleanly [pid 29470]
11: [ERROR] [gdb-6]: process[gdb-6] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
11: [ERROR] [gzserver-1]: process[gzserver-1] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
11: [INFO] [gdb-6]: sending signal 'SIGTERM' to process[gdb-6]
11: [INFO] [gzserver-1]: sending signal 'SIGTERM' to process[gzserver-1]
11: [gdb-6] Exception ignored in: <gdb.GdbOutputFile object at 0x7f5c1eb4d048>
11: [gdb-6] Traceback (most recent call last):
11: [gdb-6] File "/usr/share/gdb/python/gdb/init.py", line 43, in flush
11: [gdb-6] def flush(self):
11: [gdb-6] KeyboardInterrupt
11: [ERROR] [gzserver-1]: process has died [pid 29466, exit code -15, cmd 'gzserver -s libgazebo_ros_init.so --minimal_comms /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world'].
11: [INFO] [gdb-6]: process has finished cleanly [pid 29471]
11: [gdb-6] (gdb)
11: -- run_test.py: return code 1
11: -- run_test.py: generate result file '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml' with failed test
11: -- run_test.py: verify result file '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml'
Test #11: test_bt_navigator ................***Failed 26.09 sec

0% tests passed, 1 tests failed out of 1

@mkhansenbot
Copy link
Collaborator Author

Fail case (9) - dwb_controller crashes. We see this about 1% of the time.

11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243
11: [gdb-7] [INFO] [dwb_controller]: Received a goal, begin following path
11: [gdb-7] [New Thread 0x7fffbd542700 (LWP 5935)]
11: [gdb-7] 
11: [gdb-7] Thread 15 "dwb_controller" received signal SIGSEGV, Segmentation fault.
11: [gdb-7] [Switching to Thread 0x7fffbd542700 (LWP 5935)]
11: [gdb-7] 0x00007fffbe16afd3 in costmap_queue::CostmapQueue::enqueueCell(unsigned int, unsigned int, unsigned int, unsigned int, unsigned int) ()
11: [gdb-7]    from /home/mkhansen/ros2_dev/navigation2_ws/install/dwb_critics/lib/libdwb_critics.so
11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243

I'll file a bug on this.

11: Test command: /usr/bin/python3 "-u" "/home/mkhansen/ros2_dev/ros2_ws/install/ament_cmake_test/share/ament_cmake_test/cmake/run_test.py" "/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml" "--package-name" "nav2_system_tests" "--generate-result-on-success" "--env" "TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system" "TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml" "TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world" "GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models" "BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml" "ASTAR=True" "--command" "/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py" 11: Test timeout computed to be: 120 11: -- run_test.py: extra environment variables: 11: - ASTAR=True 11: - TEST_WORLD=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/worlds/turtlebot3_ros2_demo.world 11: - BT_NAVIGATOR_XML=navigate_w_replanning_and_recovery.xml 11: - GAZEBO_MODEL_PATH=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/models 11: - TEST_MAP=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/maps/map_circular.yaml 11: - TEST_DIR=/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system 11: -- run_test.py: invoking following command in '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/src/system': 11: - /home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_launch.py 11: [INFO] [launch]: All log files can be found below /home/mkhansen/.ros/log/2019-09-03-13-00-36-057690-mkhansen-desk-5718 11: [INFO] [launch]: Default logging verbosity is set to INFO 11: [INFO] [gzserver-1]: process started with pid [5721] 11: [INFO] [static_transform_publisher-2]: process started with pid [5722] 11: [INFO] [static_transform_publisher-3]: process started with pid [5723] 11: [INFO] [map_server-4]: process started with pid [5724] 11: [INFO] [world_model-5]: process started with pid [5725] 11: [INFO] [gdb-6]: process started with pid [5726] 11: [INFO] [gdb-7]: process started with pid [5727] 11: [INFO] [navfn_planner-8]: process started with pid [5728] 11: [INFO] [recoveries_node-9]: process started with pid [5729] 11: [INFO] [bt_navigator-10]: process started with pid [5750] 11: [INFO] [lifecycle_manager-11]: process started with pid [5771] 11: [INFO] [test_system_node-12]: process started with pid [5781] 11: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment 11: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment 11: [map_server-4] [INFO] [map_server]: Creating 11: [world_model-5] [INFO] [world_model]: Creating World Model 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Creating Costmap 11: [navfn_planner-8] [INFO] [navfn_planner]: Creating 11: [recoveries_node-9] [INFO] [recoveries]: Configuring Spin 11: [recoveries_node-9] [INFO] [recoveries]: Configuring BackUp 11: [bt_navigator-10] [INFO] [bt_navigator]: Creating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Starting the system bringup... 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Creating and initializing lifecycle service clients 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating map_server 11: [map_server-4] [INFO] [map_server]: Configuring 11: [map_server-4] [INFO] [map_server]: OccGridLoader: Creating 11: [map_server-4] [INFO] [map_server]: OccGridLoader: Configuring 11: [map_server-4] [INFO] [map_server]: Activating 11: [map_server-4] [INFO] [map_server]: OccGridLoader: Activating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating amcl 11: [gdb-7] GNU gdb (Ubuntu 8.1-0ubuntu3) 8.1.0.20180409-git 11: [gdb-7] Copyright (C) 2018 Free Software Foundation, Inc. 11: [gdb-7] License GPLv3+: GNU GPL version 3 or later 11: [gdb-7] This is free software: you are free to change and redistribute it. 11: [gdb-7] There is NO WARRANTY, to the extent permitted by law. Type "show copying" 11: [gdb-7] and "show warranty" for details. 11: [gdb-7] This GDB was configured as "x86_64-linux-gnu". 11: [gdb-7] Type "show configuration" for configuration details. 11: [gdb-7] For bug reporting instructions, please see: 11: [gdb-7] . 11: [gdb-7] Find the GDB manual and other documentation resources online at: 11: [gdb-7] . 11: [gdb-7] For help, type "help". 11: [gdb-7] Type "apropos word" to search for commands related to "word"... 11: [gdb-7] Reading symbols from /home/mkhansen/ros2_dev/navigation2_ws/install/dwb_controller/lib/dwb_controller/dwb_controller...(no debugging symbols found)...done. 11: [gdb-7] Starting program: /home/mkhansen/ros2_dev/navigation2_ws/install/dwb_controller/lib/dwb_controller/dwb_controller __params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml 11: [gdb-6] GNU gdb (Ubuntu 8.1-0ubuntu3) 8.1.0.20180409-git 11: [gdb-6] Copyright (C) 2018 Free Software Foundation, Inc. 11: [gdb-6] License GPLv3+: GNU GPL version 3 or later 11: [gdb-6] This is free software: you are free to change and redistribute it. 11: [gdb-6] There is NO WARRANTY, to the extent permitted by law. Type "show copying" 11: [gdb-6] and "show warranty" for details. 11: [gdb-6] This GDB was configured as "x86_64-linux-gnu". 11: [gdb-6] Type "show configuration" for configuration details. 11: [gdb-6] For bug reporting instructions, please see: 11: [gdb-6] . 11: [gdb-6] Find the GDB manual and other documentation resources online at: 11: [gdb-6] . 11: [gdb-6] For help, type "help". 11: [gdb-6] Type "apropos word" to search for commands related to "word"... 11: [gdb-6] Reading symbols from /home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl...(no debugging symbols found)...done. 11: [gdb-6] Starting program: /home/mkhansen/ros2_dev/navigation2_ws/install/nav2_amcl/lib/nav2_amcl/amcl __params:=/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bringup/share/nav2_bringup/launch/nav2_params.yaml 11: [test_system_node-12] [INFO] [nav2_tester]: Starting test_system_node 11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for a few seconds for all nodes to initialize 11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 separation set to [0.160000m] 11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Wheel pair 1 diameter set to [0.066000m] 11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Subscribed to [/cmd_vel] 11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Advertise odometry on [/odom] 11: [gzserver-1] [INFO] [turtlebot3_diff_drive]: Publishing odom transforms between [odom] and [base_footprint] 11: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_left_joint] 11: [gzserver-1] [INFO] [turtlebot3_joint_state]: Going to publish joint [wheel_right_joint] 11: [gdb-7] [Thread debugging using libthread_db enabled] 11: [gdb-7] Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1". 11: [gdb-6] [Thread debugging using libthread_db enabled] 11: [gdb-6] Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1". 11: [gdb-7] [New Thread 0x7fffef638700 (LWP 5900)] 11: [gdb-7] [New Thread 0x7fffeee37700 (LWP 5901)] 11: [gdb-7] [New Thread 0x7fffee636700 (LWP 5902)] 11: [gdb-7] [New Thread 0x7fffede35700 (LWP 5903)] 11: [gdb-7] [New Thread 0x7fffed634700 (LWP 5904)] 11: [gdb-7] [New Thread 0x7fffece33700 (LWP 5905)] 11: [gdb-7] [New Thread 0x7fffd7fff700 (LWP 5906)] 11: [gdb-7] [New Thread 0x7fffd77fe700 (LWP 5907)] 11: [gdb-6] [New Thread 0x7ffff01b9700 (LWP 5908)] 11: [gdb-6] [New Thread 0x7fffef9b8700 (LWP 5909)] 11: [gdb-6] [New Thread 0x7fffef1b7700 (LWP 5910)] 11: [gdb-6] [New Thread 0x7fffee9b6700 (LWP 5911)] 11: [gdb-6] [New Thread 0x7fffee1b5700 (LWP 5912)] 11: [gdb-6] [New Thread 0x7fffed9b4700 (LWP 5913)] 11: [gdb-6] [New Thread 0x7fffed0b2700 (LWP 5914)] 11: [gdb-6] [New Thread 0x7fffd7fff700 (LWP 5915)] 11: [gdb-7] [New Thread 0x7fffd67da700 (LWP 5916)] 11: [gdb-7] [INFO] [dwb_controller]: Creating 11: [gdb-7] [New Thread 0x7fffd5fd9700 (LWP 5917)] 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Creating Costmap 11: [gdb-7] [New Thread 0x7fffd57d8700 (LWP 5918)] 11: [gdb-6] [New Thread 0x7fffd71ef700 (LWP 5919)] 11: [gdb-6] [INFO] [amcl]: Creating 11: [gdb-6] [INFO] [amcl]: Configuring 11: [gdb-6] [INFO] [amcl]: initTransforms 11: [gdb-6] [New Thread 0x7fffd61ce700 (LWP 5920)] 11: [gdb-6] [INFO] [amcl]: initPubSub 11: [gdb-6] [INFO] [amcl]: Subscribed to map topic. 11: [gdb-6] [INFO] [amcl]: Activating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating world_model 11: [world_model-5] [INFO] [world_model]: Configuring 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Configuring 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "static_layer" 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "obstacle_layer" 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Subscribed to Topics: scan 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Using plugin "inflation_layer" 11: [world_model-5] [INFO] [world_model]: Activating 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Activating 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Checking transform 11: [world_model-5] [INFO] [global_costmap.global_costmap]: StaticLayer: Resizing costmap to 384 X 384 at 0.050000 m/pix 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00039 timeout was 1. 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00043 timeout was 1. 11: [gdb-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.201 for reason(0) 11: [gdb-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.401 for reason(0) 11: [gdb-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.600 for reason(0) 11: [gdb-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.801 for reason(0) 11: [gdb-6] [INFO] [amcl_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.001 for reason(0) 11: [gdb-6] [WARN] [amcl]: Waiting for map.... 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00994 timeout was 1. 11: [test_system_node-12] [INFO] [nav2_tester]: Getting amcl state... 11: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: active 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00951 timeout was 1. 11: [gdb-6] [WARN] [amcl]: Waiting for map.... 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00947 timeout was 1. 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00948 timeout was 1. 11: [gdb-6] [WARN] [amcl]: Waiting for map.... 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00039 timeout was 1. 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00012 timeout was 1. 11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose 11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose 11: [gdb-6] [INFO] [amcl]: initialPoseReceived 11: [gdb-6] [INFO] [amcl]: Setting pose (1567540846.855911): -2.000 -0.500 0.000 11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received 11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose 11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose 11: [gdb-6] [INFO] [amcl]: initialPoseReceived 11: [gdb-6] [INFO] [amcl]: Setting pose (1567540846.859687): -2.000 -0.500 0.000 11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received 11: [gdb-6] [WARN] [amcl]: Waiting for map.... 11: [test_system_node-12] [INFO] [nav2_tester]: Setting initial pose 11: [test_system_node-12] [INFO] [nav2_tester]: Publishing Initial Pose 11: [gdb-6] [INFO] [amcl]: initialPoseReceived 11: [gdb-6] [INFO] [amcl]: Setting pose (1567540847.863519): -2.000 -0.500 0.000 11: [test_system_node-12] [INFO] [nav2_tester]: Waiting for amcl_pose to be received 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00961 timeout was 1. 11: [gdb-6] [INFO] [amcl]: Received a 384 X 384 map @ 0.050 m/pix 11: [gdb-6] [INFO] [amcl]: Setting pose (1567540848.207401): -2.000 -0.500 0.000 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.201 for reason(0) 11: [gdb-6] [INFO] [amcl]: createLaserObject 11: [test_system_node-12] [INFO] [nav2_tester]: Received amcl_pose 11: [test_system_node-12] [INFO] [nav2_tester]: test_InitialPose PASSED 11: [test_system_node-12] [INFO] [nav2_tester]: Getting bt_navigator state... 11: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: unconfigured 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.600 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 1.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap.global_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: Lookup would require extrapolation into the past. Requested time 11.96000 but the earliest data is at time 12.20100, when looking up transform from frame [base_link] to frame [map]. canTransform returned after 1.00353 timeout was 1. 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap.global_costmap]: start 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating dwb_controller 11: [gdb-7] [INFO] [dwb_controller]: Configuring 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Configuring 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Using plugin "static_layer" 11: [gdb-7] [New Thread 0x7fffbffff700 (LWP 5927)] 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Using plugin "obstacle_layer" 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Subscribed to Topics: 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Using plugin "inflation_layer" 11: [gdb-7] [INFO] [dwb_controller]: Setting transform_tolerance to 0.100000 11: [gdb-7] [INFO] [dwb_controller]: DWBLocalPlanner 11: [gdb-7] [INFO] [dwb_controller]: Using critic "RotateToGoal" (dwb_critics::RotateToGoalCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "Oscillation" (dwb_critics::OscillationCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "ObstacleFootprint" (dwb_critics::ObstacleFootprintCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "GoalAlign" (dwb_critics::GoalAlignCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "PathAlign" (dwb_critics::PathAlignCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "PathDist" (dwb_critics::PathDistCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Using critic "GoalDist" (dwb_critics::GoalDistCritic) 11: [gdb-7] [INFO] [dwb_controller]: Critic plugin initialized 11: [gdb-7] [INFO] [dwb_controller]: Controller frequency set to 20.0000Hz 11: [gdb-7] [INFO] [dwb_controller]: Activating 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Activating 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Checking transform 11: [gdb-7] [INFO] [local_costmap.local_costmap]: StaticLayer: Resizing costmap to 384 X 384 at 0.050000 m/pix 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 2.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.200 for reason(0) 11: [gdb-7] [INFO] [local_costmap.local_costmap]: Timed out waiting for transform from base_link to map to become available, tf error: . canTransform returned after 1.00968 timeout was 1. 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 3.801 for reason(0) 11: [gdb-7] [INFO] [local_costmap.local_costmap]: start 11: [gdb-7] [New Thread 0x7fffbdd43700 (LWP 5928)] 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating navfn_planner 11: [navfn_planner-8] [INFO] [navfn_planner]: Configuring 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.001 for reason(0) 11: [navfn_planner-8] [INFO] [navfn_planner]: Activating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Configuring and activating bt_navigator 11: [bt_navigator-10] [INFO] [bt_navigator]: Configuring 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: Waiting for "ComputePathToPose" action server 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: "ComputePathToPose" BtActionNode initialized 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: Waiting for "FollowPath" action server 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: "FollowPath" BtActionNode initialized 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: Waiting for "/local_costmap/clear_entirely_local_costmap" service 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: "ClearEntireCostmap" BtServiceNode initialized 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: Waiting for "/global_costmap/clear_entirely_global_costmap" service 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: "ClearEntireCostmap" BtServiceNode initialized 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: Waiting for "Spin" action server 11: [bt_navigator-10] [INFO] [bt_navigator_client_node]: "Spin" BtActionNode initialized 11: [bt_navigator-10] [INFO] [bt_navigator]: Activating 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: The system is active 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 4.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.200 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 5.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.001 for reason(0) 11: [test_system_node-12] [INFO] [nav2_tester]: Getting bt_navigator state... 11: [test_system_node-12] [INFO] [nav2_tester]: Result of get_state: active 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 6.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 7.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 8.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 9.800 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.001 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 10.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.001 for reason(0) 11: [test_system_node-12] [INFO] [nav2_tester]: Setting goal pose 11: [bt_navigator-10] [INFO] [bt_navigator]: Begin navigating from current location to (0.00, 2.00) 11: [test_system_node-12] [INFO] [nav2_tester]: Waiting 60 seconds for robot to reach goal 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.201 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.401 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.601 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 11.801 for reason(0) 11: [world_model-5] [INFO] [global_costmap_rclcpp_node]: [signalFailure] Drop message: frame 'base_scan' at time 12.001 for reason(0) 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [gdb-7] [INFO] [dwb_controller]: Received a goal, begin following path 11: [gdb-7] [New Thread 0x7fffbd542700 (LWP 5935)] 11: [gdb-7] 11: [gdb-7] Thread 15 "dwb_controller" received signal SIGSEGV, Segmentation fault. 11: [gdb-7] [Switching to Thread 0x7fffbd542700 (LWP 5935)] 11: [gdb-7] 0x00007fffbe16afd3 in costmap_queue::CostmapQueue::enqueueCell(unsigned int, unsigned int, unsigned int, unsigned int, unsigned int) () 11: [gdb-7] from /home/mkhansen/ros2_dev/navigation2_ws/install/dwb_critics/lib/libdwb_critics.so 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment 11: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [bt_navigator-10] terminate called after throwing an instance of 'rclcpp::exceptions::RCLError' 11: [bt_navigator-10] what(): error taking status: error not set 11: [ERROR] [bt_navigator-10]: process has died [pid 5750, exit code -6, cmd '/home/mkhansen/ros2_dev/navigation2_ws/install/nav2_bt_navigator/lib/nav2_bt_navigator/bt_navigator --ros-args __node:=bt_navigator __params:=/tmp/launch_params_l0_vldxt __params:=/tmp/launch_params_t6dv09vk']. 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [static_transform_publisher-2] [INFO] []: LOOPING due to no latching at the moment 11: [static_transform_publisher-3] [INFO] []: LOOPING due to no latching at the moment 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [INFO] [nav2_tester]: Distance from goal is: 3.2015621187164243 11: [test_system_node-12] [ERROR] [nav2_tester]: Robot timed out reaching its goal! 11: [test_system_node-12] [ERROR] [nav2_tester]: Test FAILED 11: [test_system_node-12] /home/mkhansen/ros2_dev/ros2_ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1091: UserWarning: Pass an explicit 'qos_profile' argument 11: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument") 11: [test_system_node-12] /home/mkhansen/ros2_dev/ros2_ws/install/rclpy/lib/python3.6/site-packages/rclpy/node.py:1156: UserWarning: Pass an explicit 'qos_profile' argument 11: [test_system_node-12] warnings.warn("Pass an explicit 'qos_profile' argument") 11: [ERROR] [test_system_node-12]: process has died [pid 5781, exit code 1, cmd '/home/mkhansen/ros2_dev/navigation2_ws/src/navigation2/nav2_system_tests/src/system/test_system_node.py']. 11: [INFO] [lifecycle_manager-11]: sending signal 'SIGINT' to process[lifecycle_manager-11] 11: [INFO] [recoveries_node-9]: sending signal 'SIGINT' to process[recoveries_node-9] 11: [INFO] [navfn_planner-8]: sending signal 'SIGINT' to process[navfn_planner-8] 11: [INFO] [gdb-7]: sending signal 'SIGINT' to process[gdb-7] 11: [INFO] [gdb-6]: sending signal 'SIGINT' to process[gdb-6] 11: [INFO] [world_model-5]: sending signal 'SIGINT' to process[world_model-5] 11: [INFO] [map_server-4]: sending signal 'SIGINT' to process[map_server-4] 11: [INFO] [static_transform_publisher-3]: sending signal 'SIGINT' to process[static_transform_publisher-3] 11: [INFO] [static_transform_publisher-2]: sending signal 'SIGINT' to process[static_transform_publisher-2] 11: [INFO] [map_server-4]: process has finished cleanly [pid 5724] 11: [INFO] [gzserver-1]: sending signal 'SIGINT' to process[gzserver-1] 11: [lifecycle_manager-11] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [lifecycle_manager-11] [INFO] [lifecycle_manager]: Destroying 11: [recoveries_node-9] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [navfn_planner-8] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [gdb-7] Quit 11: [navfn_planner-8] [INFO] [navfn_planner]: Destroying 11: [world_model-5] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [map_server-4] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [world_model-5] [INFO] [world_model]: Destroying 11: [gdb-6] 11: [gdb-6] Thread 1 "amcl" received signal SIGINT, Interrupt. 11: [gdb-6] 0x00007ffff52159f3 in futex_wait_cancelable (private=, 11: [gdb-6] expected=0, futex_word=0x555555834ee0) 11: [gdb-6] at ../sysdeps/unix/sysv/linux/futex-internal.h:88 11: [gdb-6] 88 ../sysdeps/unix/sysv/linux/futex-internal.h: No such file or directory. 11: [static_transform_publisher-3] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [static_transform_publisher-2] [INFO] [rclcpp]: signal_handler(signal_value=2) 11: [INFO] [static_transform_publisher-3]: process has finished cleanly [pid 5723] 11: [INFO] [world_model-5]: process has finished cleanly [pid 5725] 11: [INFO] [static_transform_publisher-2]: process has finished cleanly [pid 5722] 11: [INFO] [recoveries_node-9]: process has finished cleanly [pid 5729] 11: [INFO] [navfn_planner-8]: process has finished cleanly [pid 5728] 11: [INFO] [lifecycle_manager-11]: process has finished cleanly [pid 5771] 11: [INFO] [gzserver-1]: process has finished cleanly [pid 5721] 11: [ERROR] [gdb-7]: process[gdb-7] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM' 11: [ERROR] [gdb-6]: process[gdb-6] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM' 11: [INFO] [gdb-7]: sending signal 'SIGTERM' to process[gdb-7] 11: [INFO] [gdb-6]: sending signal 'SIGTERM' to process[gdb-6] 11: [gdb-7] Exception ignored in: 11: [gdb-7] Traceback (most recent call last): 11: [gdb-7] File "/usr/share/gdb/python/gdb/__init__.py", line 43, in flush 11: [gdb-7] def flush(self): 11: [gdb-7] KeyboardInterrupt 11: [gdb-6] Exception ignored in: 11: [gdb-6] Traceback (most recent call last): 11: [gdb-6] File "/usr/share/gdb/python/gdb/__init__.py", line 43, in flush 11: [gdb-6] def flush(self): 11: [gdb-6] KeyboardInterrupt 11: [INFO] [gdb-6]: process has finished cleanly [pid 5726] 11: [INFO] [gdb-7]: process has finished cleanly [pid 5727] 11: [gdb-6] (gdb) 11: [gdb-7] (gdb) (gdb) 11: -- run_test.py: return code 1 11: -- run_test.py: generate result file '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml' with failed test 11: -- run_test.py: verify result file '/home/mkhansen/ros2_dev/navigation2_ws/build/nav2_system_tests/test_results/nav2_system_tests/test_bt_navigator.xml' 1/1 Test #11: test_bt_navigator ................***Failed 88.51 sec

@crdelsey
Copy link
Contributor

crdelsey commented Sep 4, 2019

After updating to the latest ROS2 and Nav2, I get fail case (8) 100% of the time. I believe the primary error in the log is

11: [world_model-5] >>> [rcutils|error_handling.c:107] rcutils_set_error_state()
11: [world_model-5] This error state is being overwritten:
11: [world_model-5] 
11: [world_model-5]   'publisher's context is invalid, at /home/crdelsey/src/ros_dev_workspace/ros2_ws/src/ros2/rcl/rcl/src/rcl/publisher.c:343'
11: [world_model-5] 
11: [world_model-5] with this new error message:
11: [world_model-5] 
11: [world_model-5]   'Could not publish transition, at /home/crdelsey/src/ros_dev_workspace/ros2_ws/src/ros2/rcl/rcl_lifecycle/src/rcl_lifecycle.c:336'
11: [world_model-5] 
11: [world_model-5] rcutils_reset_error() should be called after error handling to avoid this.
11: [world_model-5] <<<
11: [world_model-5] [ERROR] []: Failed to finish transition 3. Current state is now: active

I believe this problem ultimately triggers the lifecycle manager problem cited.

crdelsey pushed a commit that referenced this issue Sep 9, 2019
* remove nav2_robot package

* remove CMakeList and package.xml dependence on nav2_robot

* robot_util classes for publishing and states

* changing all users of robot_ to their appropriate eq.

* changing the controller to use the nav2_utils velocity publisher wrapper as well

* adding shared locks properly to share get resources

* correct namespace nav2_robot -> nav2_util

* remove sharedptr references

* resolve merge conflicts

* Setting default to use AMCL topic to true

* fix rebase/merge conflicts

deleting robot package

* removing old maintainers from navigation1

* Switch from map service to topic (#885)

* Add parameter to disable map server

* Move parameter check to getParameters

* Uncrustify

* Don't mark static layer as current until we have a map

* Make sure static layer gets initialized

Make sure static layer gets initialized, even with an empty layer, so it doesn't crash if you disable the map service and enable the obstacle layer

* remove map service from static layer

Only use map topic instead
Subscribe to map topic with default transient local volatility
Add parameter "map_subscribe_transient_local" (default=true) for backwards compatibility with volatile publishers

* Change AMCL to use only the map topic, not map service

* remove now-unused MapServiceClient

* uncrustify

* only set current_=true when first map received

* Fix nav2_costmap inflation tests.

* Fixing collision tester test.

* Revert "uncrustify"

This reverts commit 82f88a7.
This uncrustify failure is enforced differently depending on whether
we are on the dashing branch or on the master branch. This particular
commit is only appropriate on the dashing branch, but is already present
there.

* change primitives to recoveries (#705)

* change primitives to recoveries

* changing all over new bringups with nav2_recoveries

* renaming primitive_name -> recovery_name

* stop robot on cancel in recovery

* fixed recovery node halt bug

* removing nav2_robot package

* adding lifecycle publisher for dwb

* Removing unneeded tf initialization calls

* Remove dedicated thread from costmap

* Add support for new createTimerInterface API

* Fix system test launch file.

* updated the build scripts for ROS2 Dashing (#924)

* run build from anywhere in tree

* renaming dependencies because its driving me up a wall autocomplete for nav doesnt work

* remove extra files re-introduced in PR #704

* set align critics scale to 0 (#936)

* fix typo in build tool updates

* Nav2-rviz-plugin changes. (#937)

* I added a timeout to spin_until_future_complete, so rviz doesn't get frozen if something goes wrong in the navigation stack. I did some changes in the start navigation; - changed the funtion type to boolean - added returns to the funtion, so it will return false if something goes wrong. I changed goal_tool added a if statement to check if start_navigation doesn't return false before calling any other functions in goal_tool

* made the code cleaner and changed the error messages. Reduced the timeout value to 3 seconds. The timeouts will be parametrized in the future.

* added timeout parameter

* fix linter failures in Rviz plugin (#979)

* I added a timeout to spin_until_future_complete, so rviz doesn't get frozen if something goes wrong in the navigation stack. I did some changes in the start navigation; - changed the funtion type to boolean - added returns to the funtion, so it will return false if something goes wrong. I changed goal_tool added a if statement to check if start_navigation doesn't return false before calling any other functions in goal_tool

* made the code cleaner and changed the error messages. Reduced the timeout value to 3 seconds. The timeouts will be parametrized in the future.

* added timeout parameter

* Update navigation_dialog.cpp

* Update navigation_dialog.hpp

* Update navigation_dialog.cpp

* Update navigation_dialog.hpp

* Fixing typo in dependencies (#982)

* Fixing typo in dependencies

* Also remove some duplicate dependencies

* Fixing robot_state_publisher dependency

* Add support to change the local controller rate. (#970)

* Add back parameter to configure DWA rate

* Report out if we missed our control loop time.

* Fix the dashing build on OSRF build farm. (#935)

All our builds have boost installed due to other dependencies, so
we've never run into this. The build farm must build with all other
dependencies removed somehow.

* bump for release to 0.2.2

* Fix for TEB local planner buildable (#981)

Signed-off-by: vinnamkim <vinnam.kim@gmail.com>

* adding rate loops where applicable (#743)

* adding rate loops where applicable

* throttle while loops with sleep_for

* sleep_dir -> sleep_dur

* enabling closed-loop control in spin (#983)

* implemented controlled spin

* remove files reintroduced (#991)

* collision checkers in recoveries now look sufficiently far ahead in the local coordinate frame

* removing whitespace

* revert to global: need PR for TF positioning merged before can fix that

* Creating a simple action server to be able to invoke Random Crawl from BT (#945)

added random crawl action to bt

* amcl particlecloud is best effort (#1003)

Signed-off-by: Mikael Arguedas <mikael.arguedas@gmail.com>

* Disable displaying RobotModel in Rviz by default (#1001)

* returning failed if recovery cannot be completed due to collision

* backing out collision detection into a new fuction

* removing extraneous visualization from tests that have been removed

* revert my own config

* make ye old linter happy

* Footprint subscriber const topic

Signed-off-by: Shane Loretz <sloretz@osrfoundation.org>

* Costmap subscriber const topic

Signed-off-by: Shane Loretz <sloretz@osrfoundation.org>

* fixing PR feedback to stopRobot() in better location and parameterization

* removing unnecessary smart pointers that dont effect lifecycle

* lifecycle executor doesnt need to be a pointer

* removing extra PR template field in application no one uses

* Reorganize some of the BehaviorTree-related code (#957)

* Reorganize some of the BehaviorTree-related code.

Eliminate the NavigateToPoseBehaviorTree class, merging it with the BehaviorTreeEngine.
Put clear_entirely service client with the others in nav2_util.
Move RecoveryNode to nav2_behavior_tree with the other BT nodes.

* Remove method signature that isn't implemented yet

* Add a missing dependency

* Address a couple linter issues

* Tf based positioning (#993)

* remove topic based positioning for TF and removing extraneous build fields

* robot utils complete for getting positioning from TF

* readding the custom logger for getting current pose

* remove extra TODO

* fixing fun crustyness

* pass by ref not shared ptr

* wrapping costmap 2d's get pose with util

* revert costmap 2d plugin initialization swap

* fixing more uncrustified issues while I wait

* adding transform listener to buffers

* adding tf listeners and missing dependencies

* editing test cases

* trying no exception

* first stab at unit tests with TF2 for costmap 2D integration test

* adding the create timer interface

* adding updated pose info for testing

* com'n crusty code, why are you different in CI?

* fixing merge conflicts p2

* remove unnecessary CMake code to remove warning (#1005)

Signed-off-by: Mikael Arguedas <mikael.arguedas@gmail.com>

* disabling by default the debug markers for local planner (#1007)

* adding deprecation warning for topic-based goal navigation

* fixing spin recovery

* incorrect topic names

* Provide correct path to default map (#987)

* Extend the costmap's namespace with the hosting node's namespace (#999)

* Parameter dumping utility (#902)

* Add a parameter dumping utility to nav2_utils

* Add some convenience functions to simplify declaring parameters

* Add some examples for AMCL

* Remove stray example file

* Default to dumping all nodes; throw/catch exceptions

* Address some review feedback

* Fix node name collisions (#1020)

* Fix node name collisions

Make sure service clients have a unique node name (this was a problem in recoveries nodes)
Delimit ros arguments with new `--ros-args`,`--`

* Uncrustify

* Fixing linter failures introduced in master (#1029)

* Fixing linter failures introduced in master

* Sort of fix test_occ_grid_cpp test but disable since it's flaky

* Disable failing test_collision_checker test

* Recovery using odometric poses and costmaps (#1023)

* recovery behaviors using the odometric positioning for pose estimation

* use local costmap information in recoveries

* fixing costmap namespacing for collision detector

* odometry based recoveries with collision checker global frame model

* on download, rosdep all necessary items, calling on each build is redundant

* doing rosdep install in a single call

* removing extraneous cd

* adding recoveries XML to simulation launch file (#1031)

* adding recoveries XML to simulation launch file

* fix typo from name vs frame odom

* refactor goal handle into panel

clean up

remove extra log info

* remove nav2 goal tool and address review feedback

* fix lint issue

* send pose via qt signal through goal tool

* remove navigation dialog

minor clean up

* use enum for action states

fix compile issues

remove extra semicolons

fix uncrustify

* add QBasicTimer

cleanup timer

* remove more unnecessary headers

* Add parallel testing jobs for each rmw vendor

* Fix yaml

* Fix yaml

* Use custom version of nightly instead

* Extend workflow for rmw testing on release

* Fix typo

* Try speeding up build by omitting job limit

* Ensure checksum.txt exist for restoring cache

* Set --load-average +1 from -j
For a 2CPU/4096MB CI resource

* Reorganized executor and add caching nonce

Improve env DRY'ness by using separate executors

Enable debug builds

Add nonce to caching to help avoid caching key collisions
between debug and release workflow paths

* Fix awk to print env to checksum

* Add .dockerhub build hooks
and add FROM_IMAGE to arguments

* Switch to custom docker repo

* Use symlinks to place Dockerfile with hooks
Tweak build hook to compensate for dockhub assumptions
DockerHub repo build rules:

source: master
tag: master
Dockerfile: /.dockerhub/nightly/Dockerfile

source: master
tag: master-rmw
Dockerfile: /.dockerhub/nightly-rmw/Dockerfile

source: /^.*-devel$
tag: {sourceref}
Dockerfile: /.dockerhub/devel/Dockerfile

* Have CI Dockerfile use ccache

* Add .dockerignore to avoid braking build cache
So tweaking unrelated files doesn't invalidate:
COPY ./ navigation2/

* Word wrap long command

* Combine ccache with Circle CI caching

* Correct terms for underlay and overlay
upstream -> underlay
navigation2,build,source -> overlay

* Change setup_underlay to setup_dependencies

* Share ccache across overlay and underlay

* Correct typo

* Add new line

* Always save ccache
avoid unnecessary checking step

* Hack to avoid breaking docker build cache
for COPY when changing Dockerfile itself.
This shouldn't be needed,
but does not seem to work without **
¯\_(ツ)_/¯

* Add adjustable build failure behavior
When FAIL_ON_BUILD_FAILURE is unset
failures from colcon build will be supressed
allowing for docker build to succeed.
This prevents DockerHub CI images from becoming stale
when branch build brakes, previously blocking DockerHub CI image builds.

* Enable nightly release tests
now that docker CI builds unset FAIL_ON_BUILD_FAILURE
thus its status is less indicative of master build breaking

* Avoid cache collisions for PRs with same branch name
by including unique PR number into cache key

CircleCI branch name substitution using {{ .Branch }}
does not prefix names with the repo name.
Thus PRs from separate forks using the same branch name could collide.

https://circleci.com/docs/2.0/env-vars/#built-in-environment-variables
https://circleci.com/docs/2.0/configuration-reference/#save_cache

* Do not share underlay cache across branchs/PRs

* Abridge lengthening cache key names

* Account for failed underlay builds
if we don't happen to clean the underlay
when we keep the underlay from the docker image

Copy logic to overlay for consistency in behavior

* Add epoch to cache key given caches are immutable
and use spaceless string concatenation in yaml
to split long key names into multiple lines.

Given the immutability of caches,
and that cache key matching is prefix based,
{{ epoch }} must be the last part of the cache-save key.

https://discuss.circleci.com/t/add-mechanism-to-update-existing-cache-key/9014/13
https://circleci.com/docs/2.0/caching/#restoring-cache
https://circleci.com/docs/2.0/configuration-reference/#save_cache
https://stackoverflow.com/questions/3790454/how-do-i-break-a-string-over-multiple-lines/21699210#comment65667554_21699210

* Clean workspace incase build_failed

* Improve underlay build cache
By only copying .repo file for vcs import of underlay
and move overlay copy just before rosdep install for overlay

* Remove duplicate copy of overlay .repos file
given the dockerfile now copies this directly into the overlay wrokspace

* Rename workspaces to underlay and overlay
To complete the standardization of terminology
ros_ws -> underlay_ws
nav2_ws -> overlay_ws

* Add on_checkout anchor
to make config more DRY

* Target nonfree tag to include connext

* Add ccache stats command
to print and zero ccache statistics
as well as ccache version and config

after restore of ccache cache
and after each underlay/overlay build

* Cleanup code coverage pipline
Use offical Codecov orb for uploading
make the coverage script more DRY

* Remove unnecessary indents

* Split debuild build and test
and make release tests more DRY

* Shorten config

* Print out lcov command when runing script

* Use  to avoid infinite recursion

* Add common_environment refrence
and make jobs more DRY

* Store ccache logs for CI debugging

* Simplify code coverage script
to prevent untented shell glob expansion

* Rename fields

* Store test result

* Copy test results into expected directory structure
See directory structure example in
https://circleci.com/docs/2.0/configuration-reference/#store_test_results

* Store test artifacts for debug uploaded results

* Support parallel testing

* Fix xargs line splitting

* Run colcon test-results to fail on test errors
Needed to use return status from test-results

* Lookup historical timing data by classname for split-by
E.g. "costmap_queue.CostmapQueue" in `costmap_queue/utest.gtest.xml` :

<testsuites tests="5" failures="0" disabled="0" errors="0" timestamp="2019-08-12T06:57:26" time="0.499" name="AllTests">
<script/>
<testsuite name="CostmapQueue" tests="5" failures="0" disabled="0" errors="0" time="0.499">
<testcase name="basicQueue" status="run" time="0" classname="costmap_queue.CostmapQueue"/>
<testcase name="bigTest" status="run" time="0.496" classname="costmap_queue.CostmapQueue"/>
<testcase name="linearQueue" status="run" time="0" classname="costmap_queue.CostmapQueue"/>
<testcase name="crossQueue" status="run" time="0.001" classname="costmap_queue.CostmapQueue"/>
<testcase name="limitedQueue" status="run" time="0.002" classname="costmap_queue.CostmapQueue"/>
</testsuite>
</testsuites>

* Show split count and omit unneeded xargs

* Simplify build using colcon mixins
and add build args for underlay and overlay mixins

* Override mixing in build hook

* Rename build hooks and tags

* Build overlay with same settings to maximize ccache hit rate

* Correct mixin typo

* Make checksum.txt more informative
by piping message into directly into file for debugging
and simplify digests inclusion for spotting hash diffs

* Fixing up paths for codecov.io report (#1036)

* Update .dockerignore

Co-Authored-By: Carl Delsey <carl.r.delsey@intel.com>

* Move rwm jobs back into nightly workflow

* Set genhtml as default and add case for ci

* Refactor config using commands

* Use paths instead of env

* Revert ccache anchor name

* Fix install linking

* Avoid using paths as keys
prefix matching fails when key includes slashes

* Rename yaml anchor

* Make sure lcov is installed for CI

* Fix the build due to access specifiers (#1040)

No idea why this builds under GCC but these changes were needed to build under clang.

* Mark timerEvent override (#1037)

* Add dummy Dockerfiles for setting repository links on Docker Hub

* Set exit and print trace in script

* Tweek tag names

* nav2_util::duration_from_seconds -> rclcpp::Duration::from_seconds (#1048)

* nav2_util::duration_from_seconds -> rclcpp::Duration::from_seconds

* Update nav2_costmap_2d/plugins/static_layer.cpp

oops!

Co-Authored-By: Carl Delsey <carl.r.delsey@intel.com>

* Rewrite nav2_map_server (#989)

Add GraphicsMagick API and use it to implement map_saver, map_loader
Removes dependency on SDL, creates installation dependency on libgraphicsmagick++; apt package libgraphicsmagick++1-dev
Allows saving in trinary, raw, or scale mode.
Added configurable image format pgm, png, etc.
Add warning when using scale mode with opaque format.
Remove SDL from map server
Extract repeated MapMode to shared enum class
Switch writing YAML to same library that reads it (yaml-cpp)
Add --help alias to map saver -h
Extract map yaml loading to its own function, with better error messages. Also fixed crash due to misuse of std::string constructor.

* Migrate image tag to rosplanning repo

* Enable AMCL to initialize at the origin, under control of a parameter

* Make sure everything shuts down cleanly

* Some cleanup and linting

* Address review feedback

* Also have to update the YAML file

* Remove the connection object for now. Needs further investigation

* Find all uses of yaw to quaternion and use new function

* Simplify a quaternion copy

* Restore COLCON_IGNORE file

* Oops. Missed a package dependency

* Fixing a rebase error

* Add missing dependencies to system tests (#1059)

Signed-off-by: Louise Poubel <louise@openrobotics.org>

* add tf2_geometry_msgs dependency

* Fix the updown test. (#1061)

* Fixing linter errors, accidentally commited.

* Export envs for arg in build hook

* Remove the setSimTime() method - not needed anymore

* Remove ros2param package dependency

* Fix indentation (#1065)

* BT Service node & implementations (#1055)

* generic ros service caller BT node

* BT specialty service callers using BT node service

* rename to reinitialize global localization

* uncrustify/lint

* changes per PR requests

* changing pose topics to goal_pose

* Removing deprecation warning

* Removing an accidentally re-introduced file

* use seconds in Duration

* Enable global planner tester (#927)

* use duration from seconds

* Add ctest loop script to system tests

* Set line buffering to 1 in system test launch

* Update README

* Update README for using ctest_loop script

* Recombine AMCL library components with AMCL to have consistent license (#1074)

* Move AMCL library files back to nav2_amcl package

* Fixing up naming so things compile again

* Transition copyright disable check to follow eig3 files.

* Transition amcl files license to LGPL 2.1

* Adding missing copyright headers to nav2_bringup package

* Adding missing copyright headers to nav2_common

* Fixing up include guard to match coding style

* Reformatting license to pass the copyright check

The change here is only whitespace changes - line length and paragraph
spacing, as well as the addition of the license title

* Relicensing file to better match the existing package

* Fixing readme to account for the new change

* Begin updating nav2_behavior_tree README

* Continue update of nav2_behavior_tree readme

* Add link to behavior tree basic nodes to README

Adding a link to the upstream documentation on behaviortree.dev

* Clarify Licensing throughout the repo (#1080)

* Add proper SPDX license IDs and repo LICENSE file

* Fixing a minor linter typo

* Use python yaml safe loader (#1085)

* Null-terminate string to dirname function (#1093)

possibly responsible for heisenbug #1079 (comment)

* Update to latest v2 BT Library (#1088)

* Revert CreateTimer change

* Revert "nav2_util::duration_from_seconds -> rclcpp::Duration::from_seconds (#1048)"

This reverts commit 7c473cd.

* Fix dependency exports

* Fixing missing boost dependency
@AAlon
Copy link

AAlon commented Sep 16, 2019

@crdelsey @mkhansen-intel is there any update w.r.t the above? have you had the chance to retry with the latest ROS2 and if so how frequently are you seeing which errors?

Also, if folks need to use the latest ROS2, does that imply they need to use the latest navigation stack (rather than 0.2.4) as well?

Thanks!

@SteveMacenski
Copy link
Member

@AAlon yes if you're using master ROS2 you should use our master as well

@dirk-thomas
Copy link

The referenced PR ros2/rcl#501 only resolves the "This error state is being overwritten" problem reported in (8). The actual error "Failed to finish transition 3" will still be there.

@AAlon
Copy link

AAlon commented Sep 17, 2019

Going by the comments made by @crdelsey and @mkhansen-intel two weeks ago I thought there were still numerous pending issues here...? just want to make sure it was closed on purpose and not by accident.

@mkhansenbot
Copy link
Collaborator Author

@crdelsey @mkhansen-intel is there any update w.r.t the above? have you had the chance to retry with the latest ROS2 and if so how frequently are you seeing which errors?

Actually, with the latest ROS2 master (aka Eloquent), I'm not seeing any of these issues anymore. I am seeing some other issues occasionally, and will file separate issues for those, but I believe those are in our stack.

This is now closed! 👍

@dirk-thomas
Copy link

dirk-thomas commented Sep 17, 2019

Sorry, I used a wording in a referenced PR which GitHub interpreted to close this issue when it was merged - I rephrased it just now. I will reopen since it seems there are still numerous issues pending (at least it is not obvious to me that they were fixed). Due to the un-structure of this thread it is pretty hard to tell though what items are still remaining...

@dirk-thomas dirk-thomas reopened this Sep 17, 2019
@mkhansenbot
Copy link
Collaborator Author

I'm re-closing this, since I'm not seeing these issues anymore. I'm running more tests 100's of times and will file individual issues as I find them.

@dirk-thomas - THANKS for your help with this. The fixes you made do seem to help.

@SteveMacenski SteveMacenski removed the nav2_wg Request discussion in the nav2 working group label Dec 5, 2019
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
2 - Medium Medium Priority
Projects
None yet
Development

No branches or pull requests

5 participants