fixes #620
Merge pull request #621 from ros-visualization/fix620

fixes #620