Rviz2 will crash if robot hit the post in navigate (in simulate environment), have few rate navigate will not auto cancel #925
Description
Bug report
if robot hit the post in navigate, have few rate navigate will not auto cancel, in this case Rviz2 will crash.
Required Info:
- Operating System:
- Ubuntu 18.04
- Installation type:
- source
- Version or commit hash:
- dashing-devel 43f8e72
- DDS implementation:
- Client library (if applicable):
Steps to reproduce issue
Add gazebo and turtlebot module to source
1.gazebo --verbose -s libgazebo_ros_init.so /home/intel/robot_devkit/rdk_ws/Turtlebot3_ws/src/turtlebot3/turtlebot3_simulations/turtlebot3_gazebo/worlds/turtlebot3_worlds/waffle.model
2.ros2 launch turtlebot3_bringup turtlebot3_state_publisher.launch.py use_sim_time:=True
3.ros2 launch nav2_bringup nav2_bringup_launch.py use_sim_time:=True autostart:=True map:=/home/intel/robot_devkit/rdk_ws/Turtlebot3_ws/src/navigation2/navigation2/nav2_bringup/launch/turtlebot3_world.yaml
4. ros2 run rviz2 rviz2 -d $(ros2 pkg prefix nav2_bringup)/share/nav2_bringup/launch/nav2_default_view.rviz
5. press start button on Rviz
6. set initial pose
7. set goal from A to B
8. Check robot status in Rviz & Gazebo
Expected behavior
Robot can navigate from A to B and avoid post.
Actual behavior
if robot hit the post in navigate, have few rate navigate will not auto cancel, in this case Rviz2 will crash.