Fixed an occasional crash bug in rviz plugin caused by gui calls in non-gui thread.
Merge pull request #365 from ros-planning/fix-vis-crash

Fixed an occasional crash bug in rviz plugin caused by gui calls in non-gui thread.